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I. INTRODUCTION 



A. OVERVIEW OF PATH PLANNING 

Motion planning is an important problem in robotics, computational geometry, and many other applica- 
tions. A central part of motion planning, known as path or route planning, is the process of determining the 
path to be taken either by an agent’s appendages or by the entire agent. The research reported herein is con- 
cerned with the latter of these two path-planning processes. Specifically, it is concerned with planning paths 
over long distances in cross-country terrain. Thus we are not concerned with small-scale motion, where robot 
appendages are moved among objects on a work-bench or robot legs are placed on the ground, for example, 
nor with medium-scale motion, where the agent’s path must be planned so as to provide adequate clearance 
for itself, but with large-scale motion, where the size of the agent is negligible compared with the surround- 
ing terrain. 

Path planning will not typically be the only, or even the most important task which competes for comput- 
ing resources. For example, the purpose of an autonomous vehicle is to go somewhere independently and ac- 
complish a mission, a task which will require a large number of intermediate tasks which will each take 
computing time and space. Therefore it is important to find path-planning algorithms which use as few resour- 
ces as possible. This means increasing run-time speed and at the same time decreasing storage requirements. 
These are usually conflicting goals, but it is often possible to increase run-time performance or reduce storage 
at the expense of preprocessing time in a pre-mission phase when resources are not in demand. 

The problem of finding an optimal (least-cost) path between two points for a negligibly small agent over 
fixed, two-dimensional terrain with known cost characteristics can be attacked by several methods. When the 
agent is constrained to travelling on a finite number of known paths, the problem can be solved by network 
search algorithms, a subject of thorough study in operations research. When the agent is not constrained to 
travelling on specified paths, the area is called free space. Path planning in two-dimensional free space is 
beginning to be studied in depth by researchers in such fields as artificial intelligence, robotics, and computa- 
tional geometry. Most methods require homogeneous-cost background terrain interspersed with impassable 
obstacles, as for example for the Visibility-Graph algorithms [Ref. 1]. However, handling additional types of 



1 



terrain features (for example, linear low-cost features, e.g., roads, linear fixed-crossing-cost features, e.g., 
rivers, [Ref. 2] and polygonal regions of homogeneous-cost terrain, e.g., forests, swamps, or fields, [Ref. 3]) 
will improve the ability to model terrain realistically. 

A promising approach to two-dimensional path-planning in free space which we develop in this research, 
called the optimal-path-map approach, provides greatly improved nm-time speed at the expense of preprocess- 
ing lime and storage. This approach partitions the plane during preprocessing into regions with similarly-be- 
haved optimal paths and then locates a start point in this partition at run time. Figure 1 shows an example 
optimal-path map with boundaries separating the regions of similaiiy-behaved optimal paths. Additionally, a 
set of vectors is superimposed on the optimal-path map in Figure 1 showing initial directions of selected op- 
timal paths. We develop the theoretical basis for such a partitioning for a more general set of terrain features 
than has previously been used in optimal-path-map construction, making this approach more practical for real- 
world cross-country path planning. Then once the optimal-path map is constructed, our approach can appeal 
to algorithms with worst-case time complexity of 0(log n) to locate a start point in a planar partition (see Chap- 
ter II, Section B), where n is the number of terrain-feature vertices. Once the start point is located in the par- 
tition, the behavior of the optimal path is identified and the path can be reconstructed. This response time is 
very attractive, especially for real-time systems like missiles or for systems with many competing computing 
requirements like autonomous vehicles. 

The principal results of our research are threefold. First, we adapted the wavefront propagation algorithm 
to find boundaries between regions of start points whose optim al paths are similarly behaved, and implemented 
three versions of the new algorithm. Second, we characterized boundaries mathematically by means of analytic 
geometry. Third, we proposed an algorithm to construct the planar partition using these mathematical results 
for convex polygonal and piece wise-linear terrain, as an alternative to our wavefront propagation algoritlim. 

B. ASSUMPTIONS 

We assume that the terrain is known, and can be modelled by combinations of the five primitive types of 
terrain features presented below. We assume that terrain-feature edges can be modelled piecewise -linearly, 
that terrain is isotropic (traversal cost is independent of direction of travel), and that no two polygonal regions 
have common vertices. Although the mobile agent is constrained to travel in the two-dimensional plane of the 
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Figure 1 

Example Optimal-Path Map 
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input map, assigned costs of travel may reflect that the actual surface being traversed varies in height. (See 
also Chapter II, Sections C and D.) 

Following Mitchell [Ref. 4], we make the assumption called the general-position assumption (Appendix 
A, Assumption 1-3), that no terrain-feature vertex lies on a homogeneous-behavior boundary generated by 
another terrain feature, i.e., that there is not an accidental alignment of boundaries with terrain-feature ver- 
tices. This restriction does not change the following results significantly, but allows the discussion to proceed 
without convoluted, but unimportant, conventions. In an actual implementation of the algorithms proposed 
below, this assumption must be retracted. 

The following five terrain- feature types are allowed: 

• Background. Areas of the map which do not contain other terrain features have a fixed cost 
per distance travelled. 

• Obstacles. An obstacle is a convex polygon enclosing impassable terrain. 

• Rivers. A river segment is a line segment whose cost to the agent to cross anywhere along its 
length is a fixed constant, not dependent on the angle of crossing. 

• Roads. A road segment is a line segment with a fixed cost per distance for length-wise traver- 
sal. Thus a road segment is infinitesimally thin, can be crossed at no cost to the ageut, and can 
be entered or left anywhere along its length. 

• Convex Homogeneous-Cost Areas. A convex homogeneous-cost area ( HCA ) is a convex 
polygon with a constant positive cost per distance travelled. An HCA may have cost per dis- 
tance greater or less than the background terrain, but not zero. The agent may enter or leave the 
area at any point on its circumference at no additional cost. 

These terrain-feature types could all be modelled by HCAs. However, allowing obstacle, river, and road 
terrain features enhances efficiency by allowing us to take advantage of their simplicity. Specifically, it is an 
advantage to avoid, where possible, the complicated analysis of paths through homogeneous-cost regions (see 
Chapter II, Section E2b(3)). 

How realistic are the above assumptions? There are at least three issues. First, is it reasonable to expect 
that we know the characteristics of the terrain; second, can terrain be adequately modelled by piecewise linear 
curves: and third, will the use of convex non-adjacent polygons be sufficient? As discussed in Chapter II, Sec- 
tion D4, the Defense Mapping Agency and other U.S. Government agencies currently have the ability to 
produce maps which characterize terrain according to the speed at which a given vehicle type can traverse it. 
(Of course, cost in terms of time is the reciprocal of speed.) The program used to produce these maps, called 
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Army Mobility Model (AMM ), takes as input a digitized combination of soil conditions, vegetation, man-made 
features, and elevation which is available at present only for selected areas of the earth, but there is an ongo- 
ing effort to expand this database. As this database is expanded, AMM will be able to produce cost maps of 
more of the world’s surface, so that a path-planning system which uses AMM cost maps as input can be ex- 
pected to know the characteristics of the terrain. However, an additional consideration is that terrain may be 
impermanent. In this case our assumptions will be invalidated. 

The second issue is whether terrain can be adequately modelled using only piecewise linear curves. Com- 
putational geometry relies very heavily on the use of piecewise linear curves to approximate reality, since there 
is a fixed precision associated with any computer, and a finite amount of storage. In fact, the very concept of 
continuity is a mathematical abstraction, since at some level the most smoothly continuous curves will be seen 
to degenerate into discrete elements. For example, a wood-line may seem to form a continuous curve, when 
in fact at the scale of individual trees it is clearly discontinuous. Since the database maintained by the Defense 
Mapping Agency has a maximum resolution of 12.5 meters square, we can be assured that no representation 
we propose will be more accurate than this. One additional consideration is that small nuances of the terrain 
will normally have much less effect on optimal paths than will large features. Of course, it is always desirable 
from the viewpoint of efficiency to use as few line segments as possible to approximate a curve in order to 
reduce the number of terrain-feature vertices in the input map. 

The third question is much more of a problem. The use of convex polygons will clearly not approximate 
all types of terrain if we require that no two polygons have common vertices. The output of Army Mobility 
Model for example, allows non-convex polygons. This research uses the non-adjacent-convex-polygon as- 
sumption in order to attack a problem of somewhat smaller scope first, with the intention of expanding the 
scope in the future to incorporate non-convex regions. The next step will be to extend the analysis of Chapter 
V to include the case of adjacent convex polygons. 

C. THE OPTIMAL-PATH -MAP APPROACH TO PATH-PLANNING 

The optimal-path-map approach to path planning groups paths according to their general behavior with 
respect to a goal point. A surjective function is defined to map optimal paths to generalizing path descriptions 
so that paths with similar behavior are mapped to the same description. The usual definition of "similar be- 
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havior" is crossing the same sequence of terrain-feature vertices and edges. Boundaries are constructed to par- 
tition the plane of the map into regions whose start points have similar behavior. Then to determine an optimal 
path, a given start point is located within the partition. The path description of the region associated with the 
start point applies to the optimal path from the start point, so this path description is specialized for the given 
start point to give an optimal path. The focus of our research is the construction of the planar partition. 

How can paths be represe nted so they can be grouped according to their behavior? Theorem 1-2 states that 
optimal paths among piecewise-linear and polygonal terrain are always piecewise linear, changing direction 
only at terrain- feature vertices and edges. This fact suggests two possible ways to represent optimal paths. The 
more natural way to represent a single piecewise-linear path would be by listing the coordinates of its turn 
points. Alternately, we could list the terrain-feature vertices and edges at which a path turns. The first repre- 
sentation has the difficulty that there is no immediate way to tell from the list whether or not turn points from 
two different paths lie on the same terrain-feature edge. The second representation allows paths to be grouped 
more easily according to whether they cross the same terrain-feature edges and vertices, but has the difficul- 
ty that it is not clear by looking at the list what the coordinates of a turn point are on a terrain- feature edge. 
This conflict suggests a composite representation wherein a list contains terrain-feature vertices and edges, 
and for each edge, may also contains as supplemental information the exact coordinates at which the path cros- 
ses the edge. This is the representation we adopt, calling such a list a path list. 

The path list can be used to represent a specific optimal path as well as a generalized description of an 
optimal path. If a path list has a terrain-feature vertex as its first element, the path is completely determined 
because it will go from the start point directly to the vertex, from where a unique path goes to the goal (Corol- 
lary 1-3.1, Appendix A). If a path list has an edge as its first element and no supplemental information is in- 
cluded with that edge, the path list represents all optimal paths whose first turn point lies on that edge. If 
however, coordinates of the crossing point are included with the edge, the path is completely determined. When 
listing an edge in a path list, it is also important to distinguish between edges crossed from different directions, 
because for example, paths may enter the same portion of a road from both sides; we want to distinguish be- 
tween the two sets of paths which come from either side of the road. For consistency in our discussions, we 
adopt the convention that for a start point with no feasible paths (for example, a start point inside an impass- 
able obstacle), the optimal-path list is a null symbol concatenated with the goal point. 
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Now the path- generalizing function can be defined more fully for the usual definition of similar behavior 
of paths. For the set O of all optimal paths and the set (VL2E)* of all combinations of terrain-feature vertices 
and edges, the function f : O — »(V\JE)* maps an optimal path to its path list. 

Define a homogeneous-behavior region with respect to a goal G as the set of all start points whose op- 
timal paths are mapped by the path-generalizing function to the same set. Thus, start points whose optimal 
paths have the same path lists are considered to be in the same homogeneous-behavior region for the usual 
definition of the path- generalizing function. Define the root of a homogeneous-behavior region as the first ele- 
ment of the path fist associated with the region. Since a root may represent a terrain-feature edge which can 
be crossed at any point along its length, the supplemental information cannot be retained by the path fist as- 
sociated with the root. Define a homogeneous-behavior boundary as the locus of points lying in two 
homogeneous-behavior regions. On a homogeneous-behavior boundary (except for obstacle edges), at least 
two optimal paths exist for a given point. 

The fundamental principle upon which spatial reasoning about optimal paths is based is the principle of 
optimality. In its general sense, the principle of optimality states that if it applies to a system, future optimal 
policy in the system depends only on its current state and not on its past history. Theorem 1-1 (Appendix A) 
states that the principle of optimality applies to the path-planning domain. In other words, it states that the 
portion of an optimal path from any point on the path to the goal is also an optimal path. 

We extend the general-position assumption discussed above to terrain feature edges by adopting the con- 
vention that any terrain feature edge intersected by a homogeneous-behavior boundary is to be treated as two 
distinct edges, one on each side of the boundary. The immediate result of this assumption, the principle of op- 
timality, and Theorem 1-2, is the uniqueness of optimal paths from any terrain feature vertex or across the in- 
terior of any edge. (Corollary 1-3.1, Appendix A.) It follows from the definitions of homogeneous-behavior 
regions, roots, and boundaries, the general-position assumption, and Theorem 1-2 that there is a unique root 
associated with each homogeneous-behavior region (Corollary 1-3.2). It also follows that homogeneous-be- 
havior regions are "star-shaped" with respect to the region root (Corollary 1-3.3). 

An optimal-path tree of a set of terrain features with respect to a goal point is the index tree for all pos- 
sible path lists. In other words, it is the tree whose root represents the goal and whose internal nodes are ter- 
rain-feature vertices and edges, such that for each node, the optimal paths from that node's vertex or edge go 
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first to the vertex or edge represented by the node’s parent. Therefore, the path list for the vertex or edge as- 
sociated with a node is found by following the parent pointer of the node back to the root of the tree, which is 
the goal. Each node of the tree corresponds to a unique homogeneous-behavior-region root, which corresponds 
to a unique homogeneous-behavior region. Thus, locating a start point in a region of the planar partition is 
equivalent to specifying which node of the tree identifies the behavior of the optimal path from that start point. 
Figure 2 shows an example planar partition with its corresponding optimal-path tree. 

An initial version of the optimal-path tree can be constructed by using a point-to-point path planner to 
compute the optimal path from each terrain-feature vertex on the input map and then inserting the turn points 
of each resulting optimal path into a tree. The method presented in Chapters V and VI uses the optimal-path 
tree to construct the planar partition, and revises it by inserting nodes which correspond to terrain-feature edges. 
However, the method presented in Chapter III constructs the optimal-path tree at the same time as it constructs 
the planar partition. 

An optimal path map or OPM is a partition of the plane into homogeneous-behavior regions with respect 
to a goal, along with its associated optimal-path tree. There is a finite optimal-path tree associated with every 
two-dimensional map consisting of terrain as defined above (Theorem 1-4, Appendix A). The specification of 
this optimal-path tree is a necessary part of the optimal-path map, and we will assume that the term optimal- 
path map implies both the representation of the planar partition and of the optimal-path tree, with some means 
of linking each node with its corresponding homogeneous-behavior region in the partition. A typical repre- 
sentation of the planar partition is the doubly-connected-edge-list discussed in Chapter II, Section B. 

Several partitioning algorithms for terrain containing only obstacles (the binary case) have been proposed 
in an attempt to present faster solutions to the point-to-point path-planning problem (see Chapter 2), and several 
algorithms even solve a portion of the optimal-path-map problem with respect to weighted regions by creat- 
ing tire optimal-path tree in pursuit of single -path solutions. In this research, we investigate the problem of 
creating an optimal-path map for weighted-region terrain, focusing on a solution to the optimal-path-map 
problem as an end in itself. We choose to investigate this approach because it offers the most opportunity for 
enhancement of run-lime performance at the expense of preprocessing time because of the promise of O(log 
n) run-time complexity to identify an optimal path for a map of n terrain-feature vertices. 



8 



KliY: 




Figure 2 

Planar Partition with Corresponding Optinial-Path Tree 
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D. SUMMARY OF RESEARCH REPORTED HEREIN 



In Chapter II, we explain and classify the path-planning algorithms relevant to this research, specifically 
those dealing with negligible-sized agents in a fixed, known environment where terrain is two-dimensional, 
free space. 

One method of obtaining sub-optimal solutions to the optimal-path-map problem uses a version of the 
standard wavefront propagation algorithm. Such an algorithm is presented in Chapter III, and the extensions 
necessary to create optimal-path maps are developed. Chapter IV is an analysis of the algorithm in the pre- 
vious chapter. Two primary sources of error are examined, and known results of inherent inaccuracy in 
wavefront propagation are extended to the resulting OPMs. The theoretical time and space complexity of the 
above algorithm is presented, along with empirical results concerning execution times for three alternative 
heuristics used with the algorithm. 

A second approach to solving the two-dimensional optimal-path-map problem is to reason about how op- 
timal paths behave in the presence of various terrain features. This reasoning leads to analytical characteriza- 
tion of the boundaries between homogeneous-behavior regions of similarly-behaved optimal paths as functions 
of terrain feature characteristics. It turns out that all boundaries generated by the roads, rivers, and obstacles 
are segments of conic sections. Other boundaries are more mathematically complex, and in many cases can- 
not be described in closed-form expressions. First in Chapter V, a set of definitions is presented, followed by 
development of the characterizations of boundaries generated by "primitive" terrain feature types, i.e., single 
polygons and single line-segments. Then the characterization of more complex combinations of primitive ter- 
rain features is discussed, and decomposability is defined for construction of optimal-path maps. 

In Chapter VI, algorithms use the results of Chapter V to generate OPMs more accurate than those of 
Chapter III for isolated occurrences of each type of primitive terrain feature. Then an algorithm based on the 
divide-and-conquer paradigm is presented to generate OPMs for some "decomposable" maps with multiple 
terrain features. In Chapter VII the divide-and-conquer exact-OPM algorithm is analyzed, first in terms of 
sources of error, and then with respect to theoretical time and space complexity. Then the empirical perfor- 
mance of an implementation is discussed. Chapter VIII summarizes the results of the research. 
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D. RELEVANT RESEARCH 



A. APPLICABLE CONCEPTS FROM ARTIFICIAL INTELLIGENCE 
1. Search Methods 

One of the central problem-solving techniques in Artificial Intelligence is the use of search [Ref. 5], 
[Ref. 6]. A search problem is couched in terms of a current state and a goal state, operators are defined which 
transform the system from one state to another, and a search is conducted for a sequence of operators which 
will transform the current state to a goal state. Conceptually, a search space is a directed graph whose nodes 
represent all possible states, and whose edges represent operators. Solving the problem means applying graph- 
search algorithms in the search space to find a path from a start node to a goal node. The search space may be 
a very large, even an i nfini te graph which is not represented explicitly, but as the algorithm proceeds, it creates 
a sub-graph, called a search graph (or search tree), whose nodes are the states actually reached during the 
search. The underlying aim is to find ways to make the search graph as small as possible while still including 
the goal state, i.e. , to look at as few states of the search space as possible on the way to finding the goal. There 
are two ways of limiting the size of the search graph. One way is to guide the search by means of heuristics, 
and the other is to represent the problem in such a way as to reduce the search space. 

When no domain-specific information is used to guide decisions about which node of the search graph 
to process next, the process is called blind search. Although few problems have a search space small enough 
to allow practical use of blind search, the techniques used provide the foundation for heuristic search, where 
information is used to guide the search. All the search techniques discussed below can be said to conform to 
a general model where the search is initialized by placing an initial node on an agenda, and proceeds by ex- 
panding the first node on the agenda, putting the node’s children on the agenda in a manner which varies from 
technique to teclinique. 

Branch-and-bound search, also known as Dijkstra’s algorithm, is a generalization of breadth-first 
search which uses heuristic information. The distance of a node from the start is not measured by the number 
of edges from the node to the root as in breadth-first search, but by the total cost of the edges. Thus, each edge 
has an associated cost, and at each iteration, after a node has been expanded and its children placed in the agen- 
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da, the agenda is sorted by cost to keep lower-cost nodes first. Since physical distance is the normal metric in 
the path-planning domain, this is a natural search technique to use. This technique guarantees that the first path 
found to the goal is the lowest -cost solution. 

Another search strategy which is widely used in path planning is called A* search. It sorts its agen- 
da according to the sum of the cost function and evaluation function at each node. If the evaluation function 
value from any point to the goal is a lower bound on the actual cost from the point to the goal, it is guaranteed 
that the first time the optimal path to the goal is selected from the agenda it will be recognized as optimal. 

2. Domain-Specific Heuristics as Guides to Search 

General solutions to problems tackled by Artificial Intelligence researchers are usually so difficult 
that great advantages are to be gained by finding rules-of-thumb to focus the search in the right direction. 
Heuristic search strategies use cost and/or evaluation functions to guide the search. Rich [Ref. 7] states that 
the field of artificial intelligence is largely the study of heuristic search for solving difficult problems, and The 
Handbook of Artificial Intelligence calls heuristic search "one of the key contributions of Artificial Intelligence 
to efficient problem-solving" [Ref. 5]. In the path-planning domain, there is a natural heuristic which is often 
used to guide search for an optimal-cost path, which is that for a path from the start point to an intermediate 
point, if the intermediate point is closer in straight-line distance to the goal than some other intermediate point 
from another path (irrespective of terrain yet to be negotiated), the first path is preferred over the second for 
further exploration. 

3. Problem Representation 

It is often the case in problems studied in artificial intelligence research that a problem which seems 
very difficult when represented in one way will suggest a natural solution when represented in a different way. 
In other words, finding a good problem representation is often the key to efficient solution of the problem, as 
well as to clear understanding of the problem on the part of researchers [Ref. 5]. Path-planning algorithms, for 
example, are essentially ways of transforming an infinite search space to a finite one, and then searching the 
transformed search space using one of several heuristic-aided search algorithms discussed above. 
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B. APPLICABLE CONCEPTS FROM COMPUTATIONAL GEOMETRY 



1. Definitions for Optimal-Path Maps 

a. Path List 

When optimal paths are guaranteed to consist of line segments between a finite number of turn 
points, which Theorem 1-2 shows is true of the terrain considered in this research, they can be represented by 
listing these turn points. It is also shown in Theorem 1-2 that these turn points occur only at terrain-feature ver- 
tices and edges. This suggests two possible ways to list the turn points. The most direct way is to list the coor- 
dinates of the points. This allows direct reconstruction of the path from its list However, this representation 
makes it somewhat more difficult to compare two lists to determine if the paths they represent cross the same 
edges. It might be better to list explicitly the vertices and edges that a path crosses. This representation has the 
drawback, however, that some computation would be necessary to determine for each edge crossing exactly 
where the crossing occurred. Since our research is primarily concerned with grouping paths together accord- 
ing to their general behavior, we adopt the second representation, calling such a list a path list. An example 
path list from start point S to goal point G in Figure 3 is [E,A,G], while from point R there are three possible 
good path lists of [F,C,G], [H,G], and [PQ,G]. For consistency in later discussions, we say that for a start point 
with no feasible paths (for example a start point in the center of an impassable obstacle), the path list consists 
of a special null symbol concatenated with the goal point. 

b. Path-Generalizing Function 

The concept upon which the optimal-path-map approach to path planning is based is that paths 
can be grouped according to their behavior. A path-generalizing function f:0— >B is defined from the set of 
optimal paths to the set of behaviors of optimal paths, which maps an optimal path to a description of its be- 
havior. Since many paths may share the same behavior descriptions, f is a surjective function. The usual way 
to define the behavior of a path is by listing the vertices and edges it crosses. In that case B = (V^E) * , the 
set of all combinations of terrain-feature vertices and edges. Since path lists are defined in terms of vertices 
and edges, the usual definition of f is that it maps an optimal path to its path list. 

A path-generalizing relation R which relates two points if the path-generalizing function maps 
their optimal paths to identical path lists is an equivalence relation because the identity relation is in general 
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an equivalence relation. Since the domain of f is the set of all points on the input map, f induces a partition on 
the plane of the input map through this equivalence relation. 

c. Homogeneous-Behavior Region 

Define a homogeneous-behavior region with respect to a goal point and a path- generalizing func- 
tion as the set of start points whose optimal paths to that goal point are mapped by the path-generalizing func- 
tion to the same path behavior. In our work, this is equivalent to saying that it is the set of start points whose 
optimal paths have the same path lists. Each homogeneous-behavior region corresponds to an equivalence 
class of the path-generalizing relation R, and so is a subdivision of the partition induced by R on the plane of 
the input map. In Figure 3, for example, point S is in the homogeneous-behavior region enclosed by segments 
El, IK, KL, and LE. 

An optimal-path map (OPM) is defined as the partition of the plane of the input map into 
homogeneous-behavior regions, along with their associated path fists. For the conceptual representation of an 
optimal-path map shown in the top half of Figure 3, the two data structures in the bottom half of the figure 
fully specify the OPM. 

d. Homogeneous-Behavior-Region Root 

Because of the definition of homogeneous-behavior regions, each unique path fist defines a 
homogeneous-behavior region. Thus given a path list, the associated region is defined. By the general-posi- 
tion assumption (Assumption 1-3, Appendix A), there will be no accidental alignment of boundaries from 
another region such that there is more than one path list from a region. The first element of the path fist as- 
sociated with a region is defined as the liomogeneous-beliavior-region root. For example, in Figure 3 the path 
list of start point S with respect to goal point G is [E,A,G], and point E is the region root of the region of which 
S is a member. 

2. Data Structures 

Several data structures with wide utility in computational geometry are useful in the optimal-path- 
map domain. Since an optimal-path map consists of the set of path lists from homogeneous-behavior-region 
roots and a planar partition, these two items must be represented. 
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a. The Optimal-Path Tree 

The optimal-path tree is a way of representing a set of path lists. It is a direct extension of the 
shortest-path tree concept [Ref. 8]. An optimal-path tree (OPT) is a tree whose root (not the same as a 
homogeneous-behavior-region root) is the specified goal point, whose nodes are terrain- feature vertices and 
edges, and for which an optimal path from the terrain- feature vertex or edge represented by any node in the 
tree goes directly to the vertex or edge represented by that node’s parent. Each node of the tree corresponds 
to a homogeneous-behavior region, and every homogeneous-behavior region is represented by a node, (see 
Theorem 1-4, Appendix A). Thus by labeling regions and OPT nodes the same, or by establishing pointers 
from regions to nodes of the OPT, a linkage is established which allows retrieval of the appropriate OPT node 
given a region. Then the path list associated with die region can be reconstructed by tracing upwards through 
the tree to the tree’s root. Note, however, that further computation usually is necessary to reconstruct the op- 
timal path from the path list by finding optimal edge crossings. Another important characteristic of the op- 
timal-path tree is that it reduces the redundancy of storage of optimal paths associated with terrain-feature 
vertices and edges by integrating them all into one structure. In Figure 3, the optimal-path tree is shown for 
the given terrain map. 

b. The Doubly-Connected Edge List (DCEL) 

A planar partition could be represented in edge-list form in which, for each vertex of a piecewise- 
linear approximation of the boundary between subdivisions of the partition an ordered list of its incident edges 
is given. Although this is a natural representation, some of the information implicitly present could be explicit- 
ly listed, enhancing efficiency at the expense of preprocessing time and storage. A doubly-connected edge list 
is such a data structure that has proven to be quite useful in representing a planar partition. Represent each 
edge as a node in the DCEL, and label each edge, vertex, and region. Note that the terms edge and vertex as 
used in connection with the DCEL refer to piecewise-linear homogeneous-behavior-region boundary edges 
and vertices, not to terrain- feature edges and vertices. With each edge-node, associate a six-tuple of data ele- 
ments (Vi,V2,Ri,R2,Pi,P 2). The Vi are the two vertices of the edge. The assignment of vertices to the two 
fields V| and V 2 is arbitrary, but once assigned is fixed. Once the vertices are assigned, the edge becomes 
directed from V 1 to V 2 , Ri is the region (or face in the terminology of computational geometry) to the left of 
the edge, and R 2 is the region to the right. Pi is a pointer to the edge-node which is adjacent to edge V 1 V 2 in 
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a counterclockwise rotation about V 1 , and similarly for P 2 with respect to V 2 . A partial listing of the DCEL 
for the optimal-path map of Figure 3 is also shown. [Ref. 8] 

For a DCEL representing a partition with n vertices, a single pass in time O(n) can create arrays of 
headers of vertex and region linked lists, so that straightforward algorithms can retrieve the sequence of edges 
incident on a vertex or enclosing a region, in time proportional to the number of edges involved. A graph in 
edge-list form can be transformed to a DCEL in time O(n). [Ref. 8] 

An extension of the DCEL allows curved edges, as well as piecewise-linear ones, to be represented. 
Additional fields for each edge-node can be added to the DCEL to represent the algebraic form of the curve 
and to represent additional parameters necessary to specify the curve analytically. For example, if a curve rep- 
resented a segment of a hyperbola, the entry in the first additional field would note that, and the second addi- 
tional field would contain the two parameters of the equation of a hyperbola. Two points on the hyperbola, the 
endpoints of the segment, are fisted in the DCEL, so the hyperbola segment is fully specified. 

3. The Plane Sweep Paradigm 

Many algorithms in computational geometry follow the plane sweep paradigm. The idea is to process 
a geometrical structure in the plane in an ordered fashion, normally by sweeping an imaginary vertical line 
from left to right from event point to event point, where an event point is a point in the plane at which some 
action may need to be taken. Two data structures are useful in conducting a plane sweep, an event-point 
schedule and a sweep-line status. At any point along the sweep axis, the geometrical structure is characterized 
by a status which is the relation of the vertical line to the geometrical structure. For example, the status may 
be an ordered list of fine segments of the structure which intersect the sweep line. This status will change at a 
finite number of points along the sweep axis for a finitely-describable structure. These changes in status are 
the places at which the problem must be processed or analyzed. These points along the sweep axis are main- 
tained in the event-point schedule. The event-point schedule is often some form of a queue. [Ref. 8] 

4. Point-Location in the Cartesian Plane 

Linked to any algorithm that partitions the Cartesian plane in order to represent properties of points 
in each region is the requirement to retrieve those properties when queried about any point in the plane specified 
by its coordinates. Algorithms that build optimal-path maps are partitioning the plane into regions such that 
each region contains those start points with similarly-behaved optimal paths to a given goal-point. It is ncccs- 
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sary to determine in which region the point lies. If the boundaries between regions are piecewise-linear cur- 
ves, there are several algorithms from computational geometry which can be used to locate a point in the planar 
partition. 

The slab method of point location in a planar partition draws a horizontal line through each vertex of 
the partition, and then sorts the regions (or slabs ) lying between horizontal lines from top to bottom during 
preprocessing. This allows location of the point within a slab in 0(log n) time by use of bisection search based 
on the y-coordinate of the point, where n is the number of vertices in the partition. Line segments which com- 
prise the boundaries of the partition cross through each slab. Within a slab they can be ordered from left to 
right because at no point in the interior of a slab do two line segments intersect, since the slabs were defined 
by drawing horizontal lines through all the intersection points of the partition. Then bisection search can be 
used to locate the point horizontally between line segments within the slab in 0(log n) time, for a total loca- 
tion time of 0(log n + log n) = 0(log n). Two disadvantages to this method are the requirement for preprocess- 
ing time and storage space. Preparata and Shamos show how to reduce the basic 0(n log n) preprocessing 
time to 0(n ) using a plane sweep approach, but the algorithm requires at worst 0(n ) space. [Ref. 8] 

A second point-location method is the chain method. Instead of dividing the planar graph horizon- 
tally with slabs, it finds vertical chains, or connected line segments, of edges, which are monotone with respect 
to the y-axis, i.e., such that no two points on the chain have the same y-coordinate. It then constructs two bi- 
nary search trees, the first having those chains as nodes and the second having segments of chains as nodes. 
The two trees can be traversed in 0(log n) time to locate a point. A DCEL can be preprocessed in 0(n log n) 
time into the two binary search trees, which take at worst O(n) space. [Ref. 8] 

Another point-location method is the triangulation refinement method. A set of connected line seg- 
ments is said to be triangulated if each vertex is connected by a line segment with at least two other vertices, 
i.e., the line segments all form triangles. The planar partition is triangulated in 0(n log n) time by standard 
methods from computational geometry, and a hierarchy of triangulations is constructed upon which to search. 
This method leads to 0(log n) query time, 0(n log n) preprocessing time, and O(n) storage. [Ref. 8] 

An extension of the chain method, die bridged chain method, uses an elegant method that permits 
search in O(constant) time for subsequent searches, after a higher cost for a first search. It happens that the 
chain method meets the conditions for application of the bridging technique, and so bridging is used to ac- 
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cumulate information during the search process. This technique brings the chain method to efficiency com- 
parable with the triangulation refinement method. [Ref. 8] 

Although the above two methods achieve the theoretically optimum worst-case bounds, there may 
be sub-optimal methods which afford better practical performance. Specifically, the trapezoid method, which 
could be considered an extension of the slab method, gives an 0(log n) query which always succeeds in fewer 
than 4f log nl+ 3 tests, and uses 0(n log n) storage and preprocessing time. Actually, average-case storage 
may be O(n). This method has the additional property that it may be extended to curvilinear edges, so it may 
be especially useful in our application since instead of approximating curves piecewise-linearly, they may be 
represented exactly by their analytical form. [Ref. 8] 

A problem with the slab method was the 0(n ) worst-case space complexity, where n is the number 
of vertices of the graph representing the planar partition. This problem was due to the possibility that edges 
could span most of the horizontal slabs, each such edge needing to be segmented into O(n) fragments. In the 
trapezoid method, it can be shown that no more than 2 log n fragments will ever be needed for any edge, so 
no more than 0(n log n) space is required. The trapezoid method defines a trapezoid as having two horizon- 
tal sides and two other sides which may be unbounded, or else if they exist are edges of the graph not inter- 
rupted by vertices. The basic operation of the algorithm is to split a trapezoid into subordinate trapezoids. The 
progress of the splitting algorithm is paralleled by the building of a balanced binary search tree which repre- 
sents a hierarchy of subordinate trapezoids. This tree can then be searched to locate a point in a trapezoid. 
Figure 4 (adapted from Preparata and Shamos [Ref. 8]) shows an example trapezoid with its corresponding 
search tree. 

The splitting operation for the trapezoid method proceeds by finding the median y-coordinate among 
the vertices contained in the current trapezoid T and dividing T into two "slices" T i and T 2 by drawing a 
horizontal line through the median vertex. Then those edges which intersect the top or bottom horizontal side 
of T are scanned from left to right, and the first edge which also intersects the newly drawn horizontal line, 
i.e., which spans T 1 or T 2 , defines a new trapezoid T 3 . The scan continues until all edges which span Ti or T 2 
are found, with a new trapezoid being generated for each spanning edge. Note that edge ei defines the first 
new trapezoid T 3 in Figure 4 because it spans the top and median lines of T. T 3 will not need to be further split 
because there are no vertices contained in it. Spanning-edge e2 is found next, and creates Ts. Finally e 3 is 
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Figure 4 

Trapezoid Method of Point Location 



20 



found, creating T 4 . No other spanning edges are found, so T 5 and T 7 are also defined. T 4 , T 5 , T6, and T 7 all 
contain vertices of the graph in their interiors, so they will need to be split further in subsequent iterations of 
the algorithm. Triangular nodes of the search tree represent horizontal splits at graph vertices, while circular 
nodes represent the definition of new trapezoids by spanning edges. There will be n-2 triangular nodes of the 
tree, one for each except the left and right extreme vertices of the graph. Edges may form the sides of more 
than one trapezoid, however; in fact they may be fragmented into as many as 2 log n segments, as stated above. 
Thus the search tree may have as many as 0(u log n) nodes, which is the worst-case space complexity. The 
tree corresponding to the trapezoids found in Figure 4 is also shown. 

The depth of the balanced search tree can be shown to be no more than 4 T log n~|+ 3, so a search of 
the tree will take no more than that many steps. Thus the worst-case time complexity to locate a point in the 
planar partition is 0(log n). Since there are O(n) edges and each edge may be segmented into 0(log n) frag- 
ments, the time required to process the edges is 0(n log n), while both the median-finding and the tree-balanc- 
ing may be done in 0(n log n) time. Thus the preprocessing required is 0(n log n). 

An added advantage which could be useful to our research is that the trapezoid method can be ex- 
tended in some cases to finding a point among edges which are not straight-line segments. This can be done 
if first, the curves can be expressed as a single-valued function of one of the coordinates, and second, if it can 
be determined in constant time whether a point is on one side or the other of the curve. 

5. Intersections Among Line Segments in the Cartesian Plane 

A common operation of the algorithms proposed in Chapter VI is to find intersections between two 
piecewise-linear curves. It is thus important to find efficient methods of doing this operation. The intersection 
of two piecewise-linear curves with p and q segments respectively would take, using the naive approach which 
compares each segment of one curve with each segment of the other, O(pq) line segment intersections, so it 
is important to find better ways of doing the operation. 

Preparata and Shamos present an algorithm to find all intersections among n fine segments by per- 
forming a plane sweep along the x-axis. At any point on the x-axis, a vertical line imposes a total order on 
those line segments it intersects. This order is recorded in the sweep-line status. As the vertical line sweeps to 
the right from intersection point to intersection point, new line segments may be added to the ordering, and 
old ones deleted, but if any adjacent pair of line segments changes order, which is detected by a change in tlx* 
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sweep-line status, an intersection of those segments must have occurred. Thus, any line segment which is added 
to the ordering is checked for intersection with the segment immediately above and below it by checking if 
the relative order changes at the point along the x-axis where the first of the two segments will be deleted. This 
approach can detect k intersections among n line segments where n is p+q in time 0((n+k) log n). In our domain 
however, any two homogeneous-beliavior-region boundaries will intersect in at most one point, because when 
any two boundaries intersect, a third boundary will begin and the other two will end. Therefore we could use 
a simplification of the above algorithm which will operate in 0(n log n) time. [Ref. 8] 

Intersection calculation for piecewise-linear curves with monotonic curvature can exploit these 
properties. Several algorithms of uncertain worst-case complexity seem to provide good empirical results. One 
in particular [Ref. 9] proceeds by constructing, in O(p) time, a bounding box for the first piecewise linear 
curve, and then checking, in O(q) time, which portion of the second curve, if any, intersects the bounding box. 
The intersecting portion of the second curve usually contains only a small fraction, call it ki, of the whole 
curve, although it is at this point that the analysis becomes imprecise because ki does not depend on p or q, 
but on the curvature and relative positions of the two curves. In any case, the next step is to reverse the roles 
of the two curves and create another bounding box about the kiq line segments of the second curve, in O(kiq) 
time. The first curve is intersected with the new bounding box in 0(p) time, finding k2p segments which 
traverse the new box. The algorithm proceeds recursively as above, terminating when one of the bounding 
boxes contains only one line segment. At this point, the next check of the other curve will yield the exact in- 
tersection point. A rough approximation of the time complexity of this algorithm, if it is assumed for simplicity 
that at each stage the size of the curve is reduced by the same fraction k, is T = ((l+k)q + 2p)/(l-k) + 1. Thus 
this algorithm has, assuming 0<k<l, time complexity 0(q+2p) = 0(q+p) = O(n). This algorithm will not con- 
verge if at any stage the bounding box of each partial curve completely contains the other partial curve. But a 
simple check during each iteration to ensure that the sizes of the two curves are in fact decreasing will allow 
the method to proceed if it is converging. If it fails this test, a full O(pq) test of the two curves can be used in- 
stead. 

6. Voronoi Diagrams 

A technique in computational geometry that has been of use in some algorithms pertaining to op- 
timal-path maps is Voronoi diagram construction [Ref. 8]. A Voronoi diagram Vor(S) with respect to a set of 
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points S in a plane is the partition of the plane such that each region contains the points with the same nearest 
neighbor in S. Figure 5 shows a typical Voronoi diagram. One method for constructing shortest-path maps 
(i.e., an optimal-path map for binary terrain), uses an extension of Voronoi-diagram methodology to plot ap- 
proximations of the boundaries between homogeneous-behavior regions [Ref. 4]. It reduces the problem of 
constructing the planar partition to that of finding a Voronoi diagram for the vertices of an obstacle, where the 
costs of optimal paths from each vertex is known. Instead of bisectors between two vertices which are straight 
lines exactly half-way between them as described below, this method constructs bisectors which are either 
lines or hyperbola branches, depending on the nature of the paths from the two vertices. Then the Voronoi 
diagrams of single obstacles are merged to form the complete OPM. 

Some observations about Voronoi diagrams lead to an initial construction method. Between two 
points Pi and P 2 in the plane, the set of points closer to Pi than to P 2 are the points in a half-plane containing 
P 1 defined by the perpendicular bisector of the line segment P 1 P 2 . Among a set S of n points in the plane, the 
set of points closer to a point Pi than to any other point in S is the intersection of n-1 half-planes each contain- 
ing Pi defined by the perpendicular bisectors of the line segments PiPj. From this observation, a brute-force 
method of constructing a Voronoi diagram would be simply to construct each of the n polygons about each 
point in S. Since n half-planes can be intersected with each other in 0(n log n) time by a divide-and-conquer 
approach, this approach takes time 0(n log n). [Ref. 8] 

A more efficient approach for constructing Voronoi diagrams which also uses the divide-and-con- 
quer paradigm can be summarized as follows. First, partition S into two sets Si and S 2 of roughly equal size 
according to whether the x-coordiuate of each point is less than or greater than the median x-coordinate of 
points in S. Then, construct Vor(Si) and Vor(S2) recursively, and finally, merge Vor(Si) and Vor(S2) to ob- 
tain Vor(S). Partitioning S takes 0(n) time for a set S of size n using a standard median-finding algorithm and 
the merging step takes 0(n) time. If the entire algorithm can be performed in T(n) steps, the construction of 
both subordinate Voronoi diagrams in step two takes approximately 2T(n/2) time. So the recurrence relation 
T(n) = 2T(n/2) + 0(n) describes the algorithm, which when solved gives that T(n) is 0(n log n). 

The merging step is the heart of the algorillim, and is accomplished as follows. Because the map is 
partitioned such that Si and S 2 will lie on opposite sides of a vertical line, it can be shown that there is a chain 
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<7, i.e., a sequence of connected line segments, which is monotonic with respect to the y-axis, (i.e., no two 
points of the chain have the same y-coordinate) that also partitions the plane with Si and S 2 on opposite sides 
of <7 such that the union of the portion of Vor(S 1 ) which is left of <7 and the portion of Vor(S2) which is right 
of <7 yields Vor(S). In fact this chain <7 can be constructed in linear time, so the recurrence relation stated 
above holds, and the construction of a Voronoi diagram can be done in 0(n log n) time. [Ref. 8] 

Generalizations of Voronoi diagrams have been presented which partition the plane into sets of points 
closest to a set of line segments [Ref. 10], or which base their distance function on metrics other than the 
Euclidean metric [Ref. 11]. Since OPMs for homogeneous-cost areas can be thought of as Voronoi diagrams 
with a different metric for each homogeneous-behavior region, the latter work seems promising. Currently, 
however, only several simple metrics such as Li and Loohave been considered, so more research in this area 
is necessary before OPMs of the type we are considering can be constructed with this approach. Weighted 
Voronoi diagrams [Ref. 12] assign a weight to each point about which regions are computed. This concept 
might appear useful in constructing OPMs, but is not. Instead it applies to a problem in which a mobile agent 
travels at different speeds depending on which terrain- feature vertex it just crossed. 

What is needed in constructing OPMs for the binary case is a type of generalized Voronoi diagram 
in which the weight is the cost-rate of the region in which an obstacle vertex lies, and an offset of the initial 
weight at the vertex represents the cost of the optimal path from the vertex. This is, in essence, what the algo- 
rithm of Aronov [Ref. 13] computes. This algorithm allows points in the Voronoi set to be given an initial of- 
fset weight. Knowing that bisectors between such points are hyperbolas (or in the degenerate case, lines), they 
can be plotted just as in the basic Voronoi diagram algorithm. The key element of the method is the proof that 
a dividing chain can be constructed between two Voronoi diagrams as discussed above, which now can con- 
tain hyperbola segments as well as line segments. This allows smaller generalized Voronoi diagrams to be 
merged into larger ones, which is the foundation of the divide-and-conquer approach used. 

C. DEFINITIONS OF RELEVANT FREE-SPACE PATH-PLANNING PROBLEMS 

This thesis addresses problems where the mobile agent is of negligible size with respect to the surround- 
ing terrain, where terrain is two-dimensional free space with fixed terrain features, where tlie environment is 
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stable and knowledge about it is complete, and where the optimality criterion is to minimize a cost function 
which is linear in path length. 

A simplified version of this problem has been called by Lozano and Wesley [Ref. 1] and Brooks [Ref. 

14] the FIND-PATH Problem, and by Mitchell [Ref. 15] the OBSTACLE- AVOIDANCE Problem. This 

simplified problem seeks any feasible path in terrain consisting of impassable obstacles on a homogeneous- 

cost background. An important extension to the FIND-PATH Problem includes the optimality criterion that 

the resulting path be the shortest among all feasible paths. It is called the OBSTACLE- AVOIDANCE 

SHORTEST-PATH Problem, or simply the SHORTEST-PATH Problem. 

OBSTACLE-AVOIDANCE SHORTEST-PATH Problem: Given a mobile agent A of negli- 
gible size with respect to the environment, an environment E consisting of impassable obstacles at 
fixed and known locations on a homogeneous-cost background, and motion objective O consisting 
of the translation of A to a specified goal point in the environment, find a continuous path 71 for A 
amidst E that achieves objective O such that its length is minimal among all feasible paths, or report 
that no feasible path exists. 

Realistic terrain for large-scale cross-country path-planning can rarely be modelled as binary (i.e., 

obstacles on a homogeneous-cost background). A more useful assumption is that terrain can be modelled as 

homogeneous-cost regions. The map is consists of regions, each assigned a value representing the cost rate to 

the agent to traverse the region. The weighted-region problem is a generalization of the obstacle-avoidance 

shortest-path problem which defines terrain as homogeneous-cost regions. 

WEIGHTED-REGION Problem: Given a mobile agent A of negligible size with respect to en- 
vironment E, E consisting of a partition of the plane into fixed homogeneous-cost regions of known 
position, and motion objective O consisting of the translation of A to a specified point in environ- 
ment E, find a continuous path 7t for A amidst E that achieves objective O such that the path in- 
tegral of the cost is minimal, or report that no feasible path exists. 

The U.S. Army Engineer Waterways Experiment Station, the U.S. Army Engineer Topographic 
Laboratories (ETL) and the Defense Mapping Agency (DMA) currently can produce such cost-rate maps of 
environments E using a program called Army Mobility Model (AMM), for portions of the earth for which 
digitized terrain data is available. This data includes not only elevation data, but cultural, vegetation, and soil 
data as well, and must currently be collected in part manually [Ref. 16]. The output of AMM is a map in which 
terrain is subdivided according to the maximum speed with which the given vehicle could be expected to 
traverse the terrain. 
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If an application will require repeated solutions of the shortest-path or weighted-region problems, it may 

be more efficient to construct an optimal-path-map which represents optimal paths to a given goal point from 

all start points in the plane. If the output map represents solutions to the shoitest-path problem, it is called a 

shortest-path-map. Some authors use shortest-path-map to refer to maps of the weighted-region problem as 

well, allowing the word shortest to mean shortest with respect to a specified cost function. We prefer the term 

optimal-path-map, however, to emphasize its basis in the weighted-region problem. 

FIXED-GOAL OPTIMAL-PATH-MAP Problem: Given mobile agent A of negligible size with 
respect to environment E, E consisting of a partition of the plane into fixed, homogeneous-cost 
regions of known position, and a set of motion objectives © which are to translate agent A from 
each of the continuum of start points S in the plane to a goal point G, represent the set FI of con- 
tinuous paths for A in E that achieves objectives Oi in © such that the path integral for each K\ is 
minimal over all paths from start point Si to G, or report that no feasible path exists. 

D. TYPES OF PATH ERRORS 

Several classes of errors may occur in algorithms which look for optimal paths. Each algorithm is based 
on a model of the path-planning domain with its own representation of reality, and operations manipulate that 
representation to produce a solution. For example, terrain in some models is represented by imposing a grid 
on the map and assigning a cost to each cell of the grid, wliile in some models terrain is represented by polygons 
with an assigned cost. Errors may occur either because of inaccuracies in operations within the model or be- 
cause of inaccuracies in the model compared with the real-world domain. The first class below are errors of 
the former type, while the second and third classes are errors of the latter type. 

1. Cost of Model Computed Path versus Cost of Model Optimal Path 

Path-planning algorithms execute within the context of their model of real-world terrain. If an algo- 
rithm produces a solution path which has a computed cost greater than the minimum cost of some other path 
represented within the model, the algorithm has produced a model sub-optimal path. Such a solution may occur 
either intentionally or unintentionally. Some algorithms terminate when a candidate solution is guaranteed to 
be within some bound of the true model optimal solution, thus saving processing time at the expense of ac- 
curacy. An example of this type of algorithm is a variation of A* called A*e [Ref. 17]. Another example of 
an algorithm which produces solutions with this kind of error is called simulated annealling. It uses stochas- 
tic methods to determine when a candidate solution has a high probability of being good enough [Ref. 18]. Er- 
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rors of this type also occur because of numerical errors in the mathematical operations performed by the al- 
gorithm. Standard numerical analysis techniques can be used to study these errors and attempt to reduce them. 

2. Cost of Model Optimal Path versus Cost of Real-World Optimal Path 

When the cost of the optimal path within the model is different from the actual cost of a path between 
the same two points in the real world, an error of the second class has occurred. Even the actual measurement 
of a path cost is only an approximation of reality, so any model produces at least some small error of this kind. 
The amount of this kind of error produced is an important consideration in choosing among algorithms. For 
example, as discussed in Section E below, the wavefront propagation algorithm may produce solutions which 
are optimal in its grid-based model, but which have as much as 7.6% greater cost than an actual path between 
the same two points as measured in the real world. 

3. Location of Model Optimal Path versus Location of Real-World Optimal Path 

A model optimal path could still be a valuable representation of a real-world optimal path despite a 
larger cost than the true optimal cost if its qualitative behavior was similar enough to the path it represented. 
But algorithms may produce solutions which follow quite different routes than the real-world optimal path. 
As discussed by Mitchell and Kiersey [Ref. 19], the grid-based model upon which wavefront propagation (see 
Section E below) is based allows for multiple paths with the model optimal cost, so only the details of the al- 
gorithm implementation determine which one is reported as the solution, and that reported solution may dif- 
fer markedly from the true optimal path. This type of error may or may not be important depending on the 
application to which the results will be applied. 

E. RELEVANT OPTIMAL-PATH PLANNING RESEARCH 

A taxonomy for categorizing fiee-space path-planning methods is presented in Figure 6. Algorithms for 
free-space path planning generally transform an infinite search space into a finite one by eliminating all but a 
finite number of candidate paths, and then searching this finite space using standard techniques such as branch- 
and-bound or A* search. Two distinct ways used to effect this transformation to a finite search space are map 
discretization and spatial reasoning. 
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1. Map Discretization - Wavefront Propagation 

Map discretization methods approximate the terrain by imposing a tesselation on the map and 
categorizing each cell according to the terrain it overlays, and allow travel only between centers of grid cells. 
Alternate representations are possible, for example, where travel is allowed between corners of cells. Since 
there are a finite number of cells, there are a finite, though large, number of candidate paths (assuming cycling 
is prevented). A method popular for its simplicity is called wavefront propagation (see Figure 7) (Ref. 15], 
[Ref. 20]. The terrain is approximated by a square tesselation of the map, and paths are approximated by al- 
lowing motion only from the center of a cell to the center of an adjacent cell. Eight-neighbor adjacency is 
usually used, meaning that from a cell, the agent may move to any of the four perpendicularly adjacent cells 
or to any of the four diagonally adjacent cells. Because of the restrictions on directions of movement, eight- 
neighbor wavefront propagation has as much as 7.6% inaccuracy in that a reported solution may cost as much 
as 7.6% more than the real-world optimal path [Ref. 20]. Normally Dijkstra’s algorithm (branch-and-bound 
search) is used to expand in all directions from the start point until the goal is first reached. The name wavefront 
propagation is used because of the analogy of the expansion of a circular wave in water. 

The implementation of wavefront propagation reported by Richbourg [Ref. 21] is a variation of 
Dijkstra’s algorithm which models the expansion of the wavefront explicitly. The basic mechanism is that time 
is incremented in fixed units, and at each time increment the wavefront is propagated outward as far as it can 
travel through each cell currently on the wavefront. Each cell which is reached by the wavefront is added to 
the wavefront list, and when the cell’s cost has been decremented below zero it is dropped off the wavefront 
list. During each iteration, cells tlirough which the wavefront has fully passed will propagate the wave to each 
of their neighbors. If the neighbor cell has not yet been reached by the wavefront a back-pointer is set back to 
the cell on the wavefront and the neighbor cell’s cost is decremented according to how far the wavefront can 
travel through it in a unit of time. If the neighbor cell has already been reached by another cell on the wavefront, 
no action will be taken unless the neighbor cell’s cost could be decremented further by the currently propagat- 
ing cell than it was decremented by the previous cell. In that case, the pointer is changed to point to the cur- 
rent cell and the cost is set accordingly. 
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If cells are square and have unit dimensions, time could be advanced in increments such that it would 
take 1 time unit for the wave to pass through a cell of unit cost in an orthogonal direction and VT time units 
in a diagonal direction. For a cell with a cost of c, the wave will take c and c •VT time units respectively. Al- 
ternately, we will adopt the convention that time is incremented in units of V 2 , so that the wave will progress 
V7/c units of distance through a cell of cost c in the orthogonal direction in one iteration, and 1/c distance in 
the diagonal direction in one iteration. This convention provides that, for cells of integral cost, diagonal ex- 
pansion of the wave will always end inside the cell or at its edge, never overflowing into the next cell, so it is 
only in the orthogonal direction that it is necessary to check for overflow. Thus we decrement the original cost 
associated with a cell by 1 or by V 2 at each iteration, and when the remaining cost is less than zero, we know 
that the wave has passed completely through it. Figure 7 illustrates the mechanics of the wavefront propaga- 
tion algorithm. The figure shows a sequence of snapshots of the algorithm, where the remaining cost of each 
cell is noted inside the cell, and arrows represent pointers to each parent cell. The arrows are solid when the 
cell has been added to the wavefront, and dotted when the cell is not yet on the wavefront but has a back- 
pointer assigned. 

For a map of m cells, the worst-case time complexity of Dijkstra’s algorithm is 0(m log m), [Ref. 
15], or if we consider the two-dimensional nature of the input map, say of size n by n cells, the complexity is 
0(n log n). This version does not depend on the costs of cells on the map. But for the version used by Rich- 
bourg, time complexity is also a function of initial costs of the cells. Each cell will remain on the wavefront 
until its initial cost c is decremented below zero. The cell’s cost will be decremented by 1 or V 2 at each 
iteration, so each cell will remain on the wavefront for 0(c) iterations. Each iteration that a cell is on the 
wavefront, its eight neighbors will be checked to see if the shortest path yet to the neighbor cell is through the 
cell being considered, or through some already-processed cell. Thus in the worst-case where all cells have a 
cost Cm ax, if we assume that there is some upper bound on the cost of cells, the worst-case time complexity is 
0(c m ax m). In terms of an n by n input map, the worst-case time complexity is 0(c m ax n"). We must for theoreti- 
cal reasons make the assumption that there is an upper bound on the magnitude of c m ax, because if c m ax is un- 
bounded, and as usual is represented in log Cmax bits, we have that the size of the input map is I = 0(log c ma x), 
or 2 1 = c,nax. Thus the worst-case time complexity would be 0(2^). As explained in [Ref. 22], tliis type of al- 
gorithm has pseudo-polynomial time complexity, i.e., it is polynomial if the input size is bounded, but ex- 
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ponential if the input size is allowed to be unbounded. Both versions of wavefront propagation have space 
complexity of O(m). 

Dijkstra’s algorithm examines paths in all directions from the start point, regardless of which are like- 
ly to lead to the goal point quickest. But extending the algorithm to A* search by introducing an evaluation 
function gives large increases in execution speed by focusing the search on paths which seem to be proceed- 
ing in the best directions. The evaluation function used in the A* version of wavefront propagation measures 
the Euclidean distance from the cell currently being considered to the goal cell. Mitchell and Kiersey [Ref. 
19] report an increase in speed for A* search over Dijkstra’s algorithm of 1.5 to 20 times. 

Increased resolution of the tesselation will not reduce the worst-case inaccuracy of reported solutions 
below the 7.6% upper bound. This inaccuracy, called digitization bias, arises because of the discrete ap- 
proximation of paths. The only way to reduce the upper bound on error caused by digitization bias is to in- 
crease the number of possible directions the mobile agent is allowed to travel. Sixteen-neighbor wavefront 
propagation, for example, allows paths between a cell and the sixteen cells which are separated from it by one 
cell. Ricbbourg [Ref. 20] showed how sixteen-neighbor adjacency could decrease the inaccuracy to ap- 
proximately 1.9%. 

Not only does digitization bias lead to inaccuracy, it also means that multiple solution paths could be 
reported depending on implementation details of the algorithm. Path representations approximate the true op- 
timal path in the actual terrain by connected line segments which lie in allowed directions. So a true optimal 
path which for example lies at a 22.5° angle with the horizontal could be represented by one which starts in a 
45° direction, and then finishes in a horizontal direction, or it could be represented by one which alternates 
many times between small 45° line segments and horizontal line segments, somewhat like computer graphics 
routines represent lines with sets of pixels. The latter representation is to be preferred because it more close- 
ly approximates the true optimal path, and some researchers have proposed ways to augment wavefront 
propagation algorithms to favor paths which have more regular turns, so as to better approximate line seg- 
ments. [Ref. 19], [Ref. 20], [Ref. 23], [Ref. 24], [Ref. 25] 

Mitchell and Kiersey [Ref. 1 9] discuss an implementation of wavefront propagation called BITPATH 
which partially compensates for digitization bias by modifying the way in which path distances are computed. 
Vossepoel and Smeulders [Ref. 26] developed an estimate for the actual distance over a true optimal path given 
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a digitized approximation which lowers the estimate each time the approximation path turns, based on the idea 
that each turn point suggests overestimation of Euclidean distance. BITPATH incorporates this estimate as 
the cost function of A*, i.e., the value assigned to a cell to represent the cost of the best path from the start cell. 
They claim a significant improvement in BlTPATH’s ability to find a solution which not only has minimum 
cost of all possible paths, but also lies close to the true optimal path. [Ref. 19] 

In an attempt to reduce the dependency of accuracy on resolution, data representation schemes that 
use multiple resolutions have been introduced which use hierarchical algorithms which are generalizations of 
wavefront propagation [Ref. 27]. One such scheme uses quad-trees to represent larger homogeneous areas 
with single cells [Ref. 28]. With this approach, rectangles are inscribed within homogeneous-cost regions of 
the input map, and then successively smaller rectangles fill out the shape of the regions. This representation 
is then searched much the same as in wavefront propagation. 

Aparallel processing approach to wavefront-propagation path planning has been implemented in sup- 
port of the DARPA-sponsored autonomous land vehicle built by Martin Marietta [Ref. 29]. Multiple proces- 
sors are utilized to sweep horizontal bands of the map, at each cell replacing the current cost of its neighbors 
if the current cost of the cell plus the cost to move to the neighbor is less than the neighbor’s current cost. Mul- 
tiple sweeps are employed until the cost values stabilize. Richbourg [Ref. 20] suggests an alternative based on 
mesh-connected architectures in which computational elements in the architecture would model cells in the 
map, yielding an O(n) algorithm, and Jorgenson [Ref. 30] presents a wavefront propagation implementation 
on a neural-network machine. 

2. Spatial Reasoning Methods 

Spatial reasoning uses principles about how optimal paths must behave in the presence of terrain fea- 
tures to constrain the search space for optimal paths. A simple example of this type of reasoning is that op- 
timal paths are always straight lines across homogeneous terrain, and in the case of binary terrain (obstacles 
on a homogeneous-cost background), turn only at obstacle vertices (see Theorem 1-2, Appendix A). A more 
general type of discretization than that used by wavefront propagation takes place when terrain features are 
modelled using polygons. Here, error in model optimal paths versus real-world optimal paths can be much 
less than with rectangular tesselations, but since algorithms which use this type of discretization have com- 
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plexities which depend on the number of terrain-feature vertices in the map, there is a trade-off between ac- 
curacy of representation and speed of execution. 

Path-planning methods have used at least four distinct techniques which can be considered spatial reason- 
ing techniques, with many algorithms appealing to more than one of the techniques. They are visibility-graph 
methods, the Snell’s Law local optimization criterion, the continuous-Dijkstra paradigm, and methods using 
optimal-path maps. 

a. Visibility Graphs 

Visibility -Graph methods [Ref. 1] solve the polygonal obstacle-avoidance shortest-path problem 
(binary terrain), constructing a graph where each of the n obstacle vertices plus the start and goal points are 
nodes, and undirected arcs connect nodes whose vertices are intervisible, i.e., can be connected by a liue seg- 
ment which does not intersect any obstacle edge. Because of the spatial reasoning principle about binary ter- 
rain stated above, it is assured that every segment of an optimal path will occur in the visibility graph, so to 
find an optimal path it is sufficient to search the graph using branch-and- bound search. 

Several algorithms have been given to construct the visibility graph. The naive algorithm checks 
every pair of vertices against every edge to see if the line segment connecting them intersects the edge. Since 

there are 0(n ) pairs of vertices and O(n) edges, this brute force algorithm has worst-case time complexity 

3 2 

0(n ). Lee [Ref. 31] and Mitchell [Ref. 32] explain an 0(n log n) algorithm which begins by constructing for 

each vertex a list of the otlier vertices sorted according to the heading of the line between them in 0(n log n) 

time, and then for each of tlie n sorted sets, doing an angular sweep checking for intersection against the closest 

2 

obstacle edge. Welzl [Ref. 33] and Asano [Ref. 34] used the fact that n sorts can be done in 0(n ) time to build 
an 0(n ) visibility graph construction algoritlim. Ghosh and Mount [Ref. 35] give an algorithm to compute 
the visibility graph of n disjoint line segments in time 0(e + n log n), where e is the number of edges in the 
visibility graph (an output-sensitive complexity). Since e may be as small as n or as large as n , this algorithm 's 
worst-case tune complexity ranges from 0(n log n) to 0(n ) depending on tlie size of the visibility graph. 

Once the visibility graph has been constructed, Dijkstra’s algorithm or the special case of it called 
A* (see Section A), may be used to search for the shortest path from the start to the goal. The worst-case time 
complexity of Dijkstra’s algorithm is given by Aho, Hopcroft, and Ullman as 0(e log n) [Ref. 36]. Again, be- 
cause of tlie range of e, tliis means that Dijkstra’s algoritlim is, in the worst case, 0(n" log n), or with a sparse 
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visibility graph, 0(n log n). A*, an "informed" version of Dijkstra’s algorithm, has time complexity of the 

same order class in the worst case [Ref. 15], although actual implementations should show a significant em- 

2 

pirical superiority of A*. Thus, the sbortest-patb problem can be solved by a visibility-graph approach in 0(n 
log n) time. 

For the variation of the weighted-region problem (or generalization of the shortest-path problem) 
given by Rowe [Ref. 2] which considers roads and rivers as well as obstacles, a visibility-graph-influenced 
approach is used to transform the search space to a finite one. Reasoning about how optimal paths must be- 
have in the presence of roads and rivers leads to the conclusions that a path will enter or leave a road at only 
one critical angle, and that paths either cross a river without changing heading, or go around river-end vertices 
as they would an obstacle vertex. A visibility graph is constructed using as nodes all obstacle and river ver- 
tices and start and goal points; roads and rivers are not considered to obscure visibility. Additionally, line seg- 
ments from each node are constructed which intersect each road at the critical angle. If the points are otherwise 
visible, the road-intersection point is added as a node and the graph reflects that the points are connected. Fur- 
ther, all nodes which lie on contiguous road segments are connected. This graph is then searched using 
Dijkstra’s or A* algorithms as above. Figure 8 shows the edges of an example generalized visibility graph. In 
this figure, solid lines represent roads, dotted lines represent rivers, and filled polygons represent obstacles. 
Narrow dashed lines represent V-grapb edges and the thick dashed line represents the optimal path from start 
to goal points. Similar results for linear features are reported by Gewali et al. [Ref. 37] 
b. Snell’s Law Local Optimality Criterion 

Optimal paths in the weighted-region domain obey an analogy to Snell’s Law of Refraction in 

optics [Ref. 20], [Ref. 3], [Ref 38]. Snell’s Law is based on Fermat’ s Principle which says that light seeks the 

path of minimum time. Fermat’s Principle has an analogy in the weighted-region problem, since time is a cost 

proportional to distance travelled in a homogeneous-index region. Thus optimal paths follow Snell’s Law. 

Snell’s Law for Optimal Paths: An optimal path passing through an edge between two regions 
with costs-per-unit-distance ci and C2 obeys the relationship cj sin 0i = C2 sin 02, where 0| and 02 
are the angles of incidence and refraction respectively, i.e., the angle from the path in the first region 
to a line normal to the edge, and the angle from the path in the second region to a line normal to the 
edge. (See Figure 9.) 
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Figure 8 



Visibility Graph for RRR Algorithm 
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cost = Cj 




Figure 9 

Snell’s Law for Optimal Paths 
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Note that Snell’s Law is a criterion for local, not global, optimality; a non-optimal path may obey Snell’s Law 
at each edge crossing. Therefore, its usefulness is in constructing candidates for global optimality. 

The analogy to Snell’s Law applies to crossings with an angle of incidence and refraction such 
that 0i and 02 are both less than or equal to 90°. In the path-planning domain optimal paths cannot occur 
that have angles of incidence greater than a critical angle which is 0 C = sin’ 1 ci/cj, where q < Cj and Cj is the 
cost of the region on the incidence side of the edge. For example, in Figure 10 an optimal path may go from 
point S to any point to the left of point A, but may not go immediately to its right, because the angle 0 t h a t 
line AB would form with edge PQ of the high-cost region would exceed 0 C . This is called total internal 
reflection, in optics. Another example of such behavior is found in Figure 11, where a path SABG follows 
Snell’s Law making an angle exactly the critical angle at point A and then at B. 

In Figure 12, paths just to the left of SV will be refracted according to Snell’s Law as is path 
SVA, while paths just to the right of SV will be refracted as is path SVB, but paths which go through point V 
may lie anywhere within the wedge formed by AVB. If we consider that the edges which meet at point V are 
actually continuously curved there, Snell’s Law will apply as the local curvature increases to infinity. The 
same behavior happens in Figure 13, at vertex V of an obstacle. 

Finding an exact Snell’s-Law path between two points through a sequence of edges requires an 
iterative search. Richbourg [Ref. 20] and Mitchell [Ref. 15] both discuss the lack of a closed-fonn solution for 
the problem of finding the Snell’ s-Law path between two points. But since it is an easy task to trace a Snell’s- 
Law path from a point with a given heading, both conclude that an iterative search is the best approach. Rich- 
bourg studies the effectiveness of four techniques for finding, to within a given error, a Snell’ s-Law path across 
one edge. He used experiments applied to bisection search, golden-section search, false-position search, and 
a modification called heuristic false-position search, and found that the latter converged more than twice as 
fast as any of the others on the average, and also had the least standard deviation of the four methods. His 
heuristic false-position method attempts to avoid the situation where the search approaches the solution from 
the same side at each iteration, since false-position tends to converge more quickly when the solution is brack- 
eted. 

Mitchell ’s algorithm uses a numerical routine to approximate the Snell ’s-Law pat h across n edges 
which is of a time complexity that he calculates is bounded by O(nL), where L is a measure of die precision 
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Figure 11 

Snell's Law Example 2 
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Figure 12 

Snell’s Law Example 3 
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Figure 13 

Snell’s Law Example 4 
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of the problem instance. This routine is used because of its proven worst-case speed, but he also reports a coor- 
dinate descent method for solving a Snell’ s-Law path across several edges which is said to have fast empiri- 
cal convergence. This method uses as a starting path a sequence of line segments between start and goal points 
through the midpoint of each edge. It then successively adjusts each crossing point in constant time to satisfy 
Snell’s Law with respect to its two neighbor crossing points, iteratively applying these adjustments until the 
path is within a specified error of the goal. 

c. Continuous-Dijkstra Paradigm 

Path-planning methods for the weighted-region problem have used one of two similar ap- 
proaches, both relying on Snell’s Law and related properties as discussed above. Mitchell’s algorithm uses 
what he calls the continuous-Dijkstra paradigm, because of its analogy to the discrete Dijkstra algorithm [Ref. 
3], while Richbourg’s algorithm uses recursive wedge decomposition [Ref. 20], [Ref. 21]. Whereas Dijkstra’s 
algorithm must be used over terrain approximated by map discretization, the continuous-Dijkstra and the recur- 
sive-wedge-decomposition paradigms are used over terrain in which terrain features are represented by 
polygons or piecewise-linear curves. 

The continuous-Dijkstra paradigm, analogously to searching a finite graph for the next closest 
node in Dijkstra’s algorithm, searches in a concentric plane sweep outward from the start point, processing 
each terrain-feature vertex as tire sweep reaches it. The algorithm requires the triangulation of the terrain map, 
a task for which standard algorithms are available from computational geometry. Each vertex has associated 
with it a label which represents the cost of the best path yet found to it, just as in the discrete Dijkstra algo- 
rithm. Additional points, called frontier points, also have labels associated with them. They are points in the 
interior of an edge at which critical reflection occurs (see above). 

The key data structures for Mitchell’s algorithm are first, a list of subsegments of terrain-feature 
edges called candidate intervals of optimality, and second, a priority queue called the event queue after the 
terminology used in the plane sweep paradigm. Candidate intervals of optimality are the extent of an edge over 
which an optimal path could possibly lie by the constraints of Snell’s Law. Intervals include information about 
the root, or last previous vertex through which the all optimal paths which cross the interval lie, and about the 
paths from this root to either end of the subsegment interval. The event queue contains those points which are 
end points of some candidate interval, or are frontier points in the interior of an interval. 
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At each step of the algorithm, the point on the event queue with the smallest cumulative cost 
from the start point is chosen. If it is a frontier point, then the candidate interval is said to propagate. In other 
words, more candidate intervals on other edges are found each of which includes an edge subsegment to which 
optimal paths could arrive through the initial interval. The appropriate points have their costs computed and 
are added to the event queue. When the event queue becomes empty, the algorithm terminates, and the goal 
point has been labelled with its optimal cost. The list of candidate intervals holds, at any point in the algorithm, 
the best path or set of paths so far from the start point to the interval, so the interval which is the goal point is 
found in order to retrieve the optimal path. This algorithm has at most 0(n 3 ) event points, and uses the Ofn^L) 
routine discussed above to find a Snell ’s-Law path between two points, and so has a worst-case time com- 
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plexity of 0(n L), where n is the number of terrain-feature vertices and L is a measure of the precision of the 
problem instance. 

Richbourg’s algorithm uses A* search to select a group of paths for refinement which offers the 
best hope of containing the optimal path from the start point to the goal [Ref. 20J. As refined Rowe and Ricb- 
bourg [Ref. 39], a well-behaved path subspace (WBPS) is defined as a set of paths which cross the same ter- 
rain- feature edges and vertices from the start to the goal. A wedge is a partial WBPS which is a set of paths 
crossing the same edges and vertices from the start point to some intermediate point or edge. Refining a wedge 
means finding within the wedge the nearest intermediate point which has not yet been considered, finding a 
Snell’s-Law path to that point, and splitting the wedge into three sub-wedges based on the cases which arise 
from Snell’s Law. These three wedges are added back to the A* agenda for further consideration. Two of the 
three wedges are those consisting of paths which pass to the "left" and "right" of the point at which splitting 
occurs, while lire middle wedge is constructed based on the possible behavior of paths emanating from the 
point. The tenn recursive wedge decomposition refers to the successive splitting of wedges as they are selected 
from the A* agenda and refined. 

The search space for recursive wedge decomposition is a known feasible start-to-goal path and 
a set of wedges with associated lower-bound values of cost function plus evaluation function for each wedge. 
These lower-bound values represent the lowest possible cost for a path within the wedge. The known feasible 
path is replaced whenever a better path is found, so that it is always the best known path. The single operator 
for state transfonnation is wedge refinement. The algorithm uses a different termination criterion than that 
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normally used by A* in path-planning applications. Normally the search can stop when the first element on 
the agenda is a complete solution, because the agenda is ordered by increasing cost-function plus evaluation- 
function values, and for a complete path the evaluation function equals zero and the cost function is the ac- 
tual cost from start to goal. However, in this search space, the elements on the agenda are wedges, not paths. 
The search terminates when the best wedge on the agenda (and hence all other wedges on the agenda as well) 
has a cost- function plus evaluation- function value that exceeds the upper-bound cost of the current best feasible 
known path, or when the agenda is empty. In either case the least-cost known path is the solution. Wedges are 
pruned, or removed from the search space, according to a set of criteria based on Snell’s Law and other spa- 
tial reasoning. An implementation of Richbourg’s recursive-wedge-decomposition algorithm is reported to 
have empirical performance which strongly suggests an 0(n ) average-case time complexity, where n is the 
number of terrain-feature vertices. Worst-case time complexity was reported to be 0(n!n ) [Ref. 39]. 

The two algorithms are quite similar in some respects. The candidate interval of the continuous- 
Dijkstra algoritlim along with its associated data about boundary paths corresponds to the wedges of the recur- 
sive-wedge-decomposition algorithm, and propagation of intervals corresponds to refinement of wedges. The 
same properties of Snell’s Law refraction and critical reflection are used in determining how to refine wedges 
(propagate intervals). However, there are differences of emphasis. The focus of the continuous-Dijkstra algo- 
rithm seems to be finding a polynomial-time worst-case algorithm, while the A* search of the recursive-wedge- 
decomposition algorithm focuses on average-case performance. The continuous-Dijkstra algorithm requires 
a triangulation of the input map, a time-consuming preprocessing step which nevertheless does not raise the 
worst-case time order of complexity, while the recursive-wedge-decomposition algorithm takes as input a map 
of polygonal terrain features. The recursive-wedge-decomposition implementation reported in [Ref. 21] was 
used in our research for initialization in our Chapter VI algorithms. 

A generalization of the weighted-region problem allows anisotropic costs in regions, that is, costs 
which are a function of the direction of travel of the mobile agent, for example, in steeply sloped terrain. Ross 
[Ref. 40] solves the anisotropic weighted-region problem using a variation of recursive-wedge decomposition. 
Based on the effects of gravity, friction, and maximum force which can be applied by the agent, there are 
several sets of impermissible headings which may constrain travel across a polygonal region. A range of uphill 
headings may be ruled out by maximum force available, loss of traction, or catastrophic overturn, and a range 
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of sideslope headings may be ruled out by catastrophic overturn considerations. Additional optimality con- 
siderations include a range of downhill braking headings within which the agent must lose energy by braking, 
and Snell’s Law for optimal paths as described above. Given these constraints, there are only four ways an op- 
timal path can cross an anisotropic region. This insight leads to an algorithm which recursively decomposes 
groups of potentially optimal paths according to which terrain-feature vertices and edges they cross ( window 
sequences), and applies A* search to these groups of paths, using various pruning criteria to limit the search 
space. 

d. Optimal-Path Maps 

Several researchers have used optimal-path maps (OPM), or as they are commonly called with 
respect to binary terrain, shortest-path maps, as a means of solving the shortest-path, binary-terrain problem. 
Lee and Preparata [Ref. 41] give an 0(n log n) algorithm to construct an OPM for the special case that all 
obstacles are parallel line segments, and Reif and Storer [Ref. 42] give an 0(mn + n log n) algorithm, where 

7 

m is the number of obstacles and n is the number of obstacle vertices. Mitchell [Ref. 4] gives an 0(kn log n) 
algorithm for the general case, where k is an output-sensitive parameter somewhat related to the density of 
obstacles in the plane. 

The algorithm of Lee and Preparata uses the plane sweep paradigm and constructs both the op- 
timal-path tree and the planar partition with one sweep of the plane. Assuming without loss of generality that 
the parallel line-segment obstacles are vertical and the start point is to the left of all obstacles, the sweep line 
is also vertical and begins at the start point. The obstacles are indexed by their x-coordinates, and the initial 
event queue contains the x-coordinates of each obstacle. As the sweep line encounters an obstacle, it locates 
the two endpoints in regions of the OPM so far constructed and extends the optimal-path tree by inserting a 
node for each obstacle endpoint into the tree at the node associated with these regions. Then it constructs the 
three bisectors, or homogeneous-behavior region boundaries, which begin at the obstacle, two of which are 
rays and one of which is a hyperbola segment. It updates a list of "active" bisectors by deleting previously- 
found bisectors which intersect the current obstacle, and adds the new bisectors to the list. Then it updates the 
event queue by iaserting points of intersection of the new bisectors with any other bisectors. Only the left- 
most such intersection must be recorded. At each stage, the OPM is updated when both endpoints of a bisec- 
tor are found. [Ref. 41] 
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The algorithm due to Reif and Storer takes as input a triangulation of the obstacle edges, and 
recursively processes these triangles to find shortest paths from the start point to each vertex of the triangula- 
tion. The algorithm "grows" outward from the start point, constructing a partition of the plane. The discussion 
of this algorithm in Reference 42 is somewhat obscure, as it does not use the terminology of shortest-path 
maps, and depends on other algorithms and data structures not fully explained in Reference 42. 

A solution to the optimal -path-map problem which takes a different approach is presented by 
Payton [Ref. 43]. It is built on the wavefront propagation algorithm, and consists of storing the back-pointers 
for each cell. This array of pointers is called a gradient field, and provides information about which direction 
a mobile agent should go from any point on the map in order to travel along an optimal path. This approach 
could be used with other point-to-point path planners as well, although with greatly increased preprocessing 
lime, by simply running the path planner for a finely-grained array of start points, and storing the initial direc- 
tion of the resulting optimal path for each run. 

Mitchell’s algorithm introduces the concept of "generalized visibility" within the obstacle space, 
and constructs shortest-path maps for each new level of visibility. This algorithm begins by computing the 
visibility polygon from the start point, i.e. , the polygon containing all points in the map which are not occluded 
from the start point by an obstacle edge. Then it appeals to the algorithm for constructing generalized Voronoi 
diagrams within simple polygons due to Aronov [Ref. 13] which takes into account that boundaries may be 
hyperbolic or linear, depending on the costs of optimal paths from obstacle vertices. Using this generalized- 
Voronoi-diagram concept, Mitchell’s approach constructs a shortest-path map for die visibility polygon. Then, 
the algorithm computes the second level of visibility, that is, extends the visibility polygon to include all points 
visible from any part of the initial visibility polygon. Again, it reduces the problem of extending the shortest- 
path map to the problem of defining appropriate Voronoi-diagram problems on simple polygons. This process 
continues iteratively until all obstacles have been found by the generalized visibility process. [Ref. 4] 

So essentially, Mitchell’s algorithm is doing a concentric plane sweep (although not using this 
terminology), where at each iteration, the next generalized visibility polygon is found, a Voronoi diagram is 
constructed for the obstacles in the polygon, and these Voronoi diagrams are merged with the Voronoi diagram 
from the previous iterations. The computation of visibility polygons does use the plane sweep paradigm ex- 
plicitly, sweeping a "geodesic" (or optimal) path angularly about the start point. In order to deal with several 
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cases in which a single sweep would not correctly identify all the event points, two sweeps, one in each direc- 
tion about the start point, are done to compute each visibility polygon. This algorithm operates in 0(n log n) 
worst-case time, where n is the number of obstacle vertices in the input map. [Ref. 4] 

The focus of this dissertation is on the construction of a planar partition for the weighted-region 
problem. In keeping with the convention discussed above of referring to solutions to the weighted-region 
problem as optimal paths instead of shortest paths, we refer to such a partition as an optimal-path map. Mitchell 
[Ref. 15], claims to have constructed an optimal-path map for the weighted-region problem, but does not men- 
tion the task of constructing region boundaries. His algorithm appears to construct, instead, an optimal-path 
tree, a necessary and time-consuming first step in constructing an optimal-path map, but gives little attention 
to construction of the planar partition. This confusion may arise from the fact that in the binary-terrain domain, 
construction of region boundaries is straightforward, a fairly insignificant part of the total problem, while the 
added complexity of the weighted-region problem creates additional complexities in the characterization of 
boundaries and the construction of the optimal-path map. In binary terrain, the standard Voronoi-diagram 
methods which construct straight-line bisectors only need to be extended to construct hyperbola segments as 
well, while in weighted-region terrain, such bisectors take on many different forms. Thus the problem of "defin- 
ing tiie appropriate Voronoi-diagram problem", as Mitchell does in the binary case, is a much more difficult 
one. 
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HI. MODIFYING WAVEFRONT PROPAGATION TO FIND SUB-OPTIMAL 
SOLUTIONS TO THE OPTIMAL-PATH-MAP PROBLEM 

A. OVERVIEW 

Wavefront propagation is well-suited as a method for solving the fixed-goal optimal-path-map problem 
(see Chapter II, Section C for a complete description of this problem), if the inherent error is acceptable in the 
application domain. The basic wavefront propagation algorithm can easily be extended by considering, for 
each cell on the wavefront, whether there should be a boundary between it and its adjacent cells, using one of 
the three definitions of "similar behavior". What for the point-to-point problem was a disadvantage of 
wavefront propagation, that the algorithm in its basic form searched blindly in all directions without regard to 
the location of the goal, becomes an advantage for the optimal-path-map problem because the paths from each 
cell in the map are available as a by-product of the algorithm simply by tracing the back pointers. Another ad- 
vantage is that the asymptotic worst-case time complexity of the extension is the same as the basic algorithm. 

In chapter II the path-generalizing function was defined in terms of "similar behavior" of paths. In this 
chapter we solidify the meaning of "similar behavior" to group paths in three different ways that make sense 
for wavefront propagation, thus defining the path-generalizing function in three ways. The first way produces 
boundaries between adjacent cells whose goal paths turn at cells which are not "equivalent". The second way 
uses a set of heuristics to group cells whose goal paths converge. The third way groups cells according to 
whether their paths turn at the same terrain- feature vertices and edges. 

It might be possible to bypass the need for an optimal-path map altogether by simply storing back pointers 
for every cell in the map (for example, in the work of Payton discussed in Chapter II [Ref. 43], such a database 
of pointers is called a gradient field). Given a start cell ’s coordinates, the path to the goal could be reconstructed 
by following the pointers back to the goal cell. There are two disadvantages to this method. First, the average- 
case time complexity to reconstruct a backpath is O(n), for an input map of size n by n. Second, the storage 
requirement for the optimal-path map is 0(n“ ). To avoid these problems, we store an optimal-path map. 
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B. MODIFYING THE PATH-GENERALIZING FUNCTION FOR WAVEFRONT 



PROPAGATION OPTIMAL-PATH-MAP CONSTRUCTION 

1. The Pure Version of Wavefront-Propagation Optimal-Path-Map Construction 

The most natural description of a path is the list of all cells from start point to goal point. Requiring 
two such path lists to be identical in order to represent "similar behavior" would result in every cell in the map 
comprising its own homogeneous-behavior region. But it is unnecessary to include all cells in a path segment 
which lie in on the same straight line. So another definition of a path list is the list of cells at which the op- 
timal path turns, or more precisely, the cells in the backpatli of a start point for which each back-pointer of the 
cell is in a different direction than the back-pointer of the cell’s parent. 

This definition still induces many distinct regions. A modification is to specify that two turn-point 
cells on different backpaths are considered equivalent if one of them lies on the first leg of the optimal-path 
list which starts at the other turn-point. Thus, for example, the two cells (5,3) and (6,2) in Figure 7 would have 
optimal-path lists [(5, 5), (7, 7)] and [(6,6), (7, 7)] respectively; cells (5,5) and (6,6) would be considered 
equivalent because the optimal-path list of cell (5,5) is [(7,7)] and (6,6) lies on the line between (5,5) and (7,7); 
so cells (5,3) and (6,2) he in the same region. 

We call the version of the wavefront propagation optimal-path-map algorithm which uses this defini- 
tion of the path- generah zing function the pure version, since it is based on a simple definition of homogeneous- 
behavior regions. Changes to the basic wavefront propagation algorithm in Appendix B necessary to implement 
tliis are presented in Table 1 below (two pages). The key change is a check for boundaries between each cell 
on the wavefront and its four neighbors. This is accomplished in procedure expand-cell which is executed 
once for each cell on the current wavefront. Procedure expand-cell calls procedure check-for-boundaries 
which compares the path lists of each of the cell’s neighbors with the expanding cell’s path list, checking for 
"equivalency" as defined above. Whenever a new cell is added to the wavefront, its path list is set by proce- 
dure set-optinial-path-list which is called from williin orthogonal-expand, diagonal-expand. and overflow. 
These procedures, although not shown here, are modified from the versions shown in Appendix B by adding 
a call to set-optimal-path-list after each new cell is added to the wavefront list or the overflow list. When the 
procedure check -equivalent-paths called by check-for-bouudaries detennines that two path lists arc not 
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TABLE 1 



WAVEFRONT-PROPAGATION OPM ALGORITHM 



algorithm wavefront-propagation-opm 
input: Goal-Point 

i 

Wavefront := Goal-Point; 
Boundary-List := empty list; 
while (Wavefront not empty) 
expand-wavefront(Wavefront); 



(Algorithm IT1-1) 

/* REVISED from algorithm B-l */ 

/* in Appendix B. */ 

/* Iteratively expand wavefront */ 

/* until nothing remains on it. */ 

/* end of wavefront-propagation-opm */• 



procedure expand-wavefront /* REVISED PROCEDURE */ 

input: Wavefront 

I 

if (Wavefront is empty) /* Base case of the recursion. */ 

I 

Cells-for-New-Wavefront := empty list; 

New-Wave front := empty list; 

} 

else 



} 



{ 

Current-Cell := cell on Wavefront with min remaining 
expand-cell(Current-Cell); 

Rest-of-Wavefront := Wavefront less Current-Cell; 
expand-wavefront(Rest-of- Wavefront); /* 

New-Wavefront := Cells-for-New-Wavefront /* 

appended onto front of New-Wavefront; /* 

) /* 

I* 



cost; 



recursive call to expand-wavefront */ 
Note: Wavefront is recursively emptied */ 
out level by level and New-Wavefront */ 
is built up as each level returns. */ 
end of expand-wavefront */ 



/* REVISED PROCEDURE */ 



/* initialize flag assuming that Current-Cell */ 
/* will not stay on Wavefront */ 

/* ADDED TO THIS VERSION */ 

/* ADDED TO THIS VERSION */ 



procedure expand-cell 
input: Current Cell 

I 

Finished-With-Cell :=TRUE; 
clieck-for-boundaries(Current-Cell); 

Boundary-List := New-Boundary-List appended 
to Boundary-List: 

Cells-for-New-Wavefront := empty list; 
for (New-Cell := North-, East-, South-, and West-Neighbor) 
orthogonal-expand(Current-Cell, New-Cell); 
for (New-Cell := Northeast-, Southeast-, Southwest-, and Northwest-Neighbor) 
diagonal-expand(Current-Cell, New-Cell); 

if not (Finished-With-Cell) /* keep Current-Cell on Wavefront */ 

Cells-for-New-Wavefront := Current-Cell appended 

onto Cells-for-New-Wavefront; /* CHECK FOR GOAL DELETED *J 



I 



/* end of expand-cell */ 



TABLE 1 (CONTINUED) 

WAVEFRONT-PROPAGATION OPM ALGORITHM 



procedure check-for-boundaries /* NEW PROCEDURE */ 

input: Current-Cell 

{ 

New-Boundary-List := empty list; 
for (Neighbor-Cell := each of 
Current-Cell’s eight neighbors) 

if not (Parent-Pointer of Neighbor-Cell = nil) /* if wavefront has reached neighbor, */ 

{ /* a boundary check can be made. */ 

OPL1 := OPL-Parent of Neighbor-Cell; 

OPL2 := OPL-Parent of Current-Cell; 

if not (clieck-equivalent-paths(OPLl,OPL2)) /* update new boundary list */ 
New-Boundary-List := edge or comer 

connecting the two cells appended to New-Boundary-List; 

} 

} /* end of check-for-boundaries */ 



procedure set-optimal-path-Iist 
input: Cell 

I 

if (Parent of Cell is on line segment between 
Cell and OPL-Parent of Parent of Cell) 
OPL-Parent of Cell := OPL-Parent 
of Parent of Cell; 

else 

OPL-Parent of Cell := Parent of Cell; 

) 

procedure check -equivalent-paths 

input: OPL1, the OPL-Parent of Neighbor-Cell 
and OPL2, the OPL-Parent of Current-Cell 
output: returns TRUE if paths are 
equivalent, FALSE otherwise. 

I 

if ((first cell of OPL1 = first cell of OPL2) 
or (first cell of OPL1 is on the line 

between first and second cells of OPL2) 
or (first cell of OPL2 is on die line 

between first and second cells of OPL1) 
retum(TRUE); 
else return (FALSE): 



/* NEW PROCEDURE */ 

/* NOTE: There are two parent-pointer fields in */ 
/* the "Cell" array - "Parent" field is predecessor */ 
/* of Cell on the backpath: "OPL-Parent" is the */ 
/* predecessor on the Optimal-Path List. */ 



/* end of optinial-path-Iist */ 
/* NEW PROCEDURE */ 



/* Paths are equivalent if first */ 
/* pair of cells are equivalent */ 



/* end of check-equivalent-path.s */ 
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equivalent accorduig to the above definition, the edge wliich the two cells share is considered a boundary and 
is added to a list of boundaries. 

Since each cell with non-infinite cost is on the wavefront once during the algorithm, we will in the 
end check each cell on the map. For two adjacent cells, if one cell is has been reached by the wavefront and 
the other has not yet been reached, the second cell’s path list will not yet be determined, so a boundary check 
is not yet possible. But when the second cell is finally put on the wavefront, its path list is set and a check of 
its neighbors will consider the first cell. So it is guaranteed that all pairs of neighbors will be checked by the 
end of the algorithm, and all boundaries between cells will be detected. 

Note that references to the start point have been deleted from the algorithm, since we are looking for 
paths to all start points. The initial center of the wavefront is called the goal point. Also, there is no possibility 
for die algorithm to fail because of an inability to find the start point. When no cells remain on the wavefront, 
die program is done. Then the list of boundaries will be transformed into die appropriate data structure, a doub- 
ly-connected edge list, and the path infonnation will be transformed into an optimal-path tree. 

The procedure set-optimal-path-list will be called by procedures orthogonal-expand, diagonal-ex- 
pand, and overflow each time a new cell is appended onto the Cells-for-New-Wavefront or Overflow lists 
respectively. 

Figure 14 (on two pages) shows die result of applying the pure definition of the padi- generalizing 
function to wavefront propagation, with a map consisting of a single obstacle and a single high-cost area. The 
figure shows successive snapshots over time as die wavefront expands and the back-pointers are set. The 
wavefront expands from the goal point in the center, and back pointers show the optimal path from each stait 
point to the goal point. Homogeneous-behavior boundaries are shown as dotted curves. (Several horizontal 
backpaths appear darker than the others only because of die resolution of the printer used.) Figure 14a shows 
the first tliree snapshots, and Figure 14b shows die fourth snapshot and a final frame with backpaths removed 
for clarity. 

Several homogeneous-behavior boundaries in Figure 14 are spurious, that is, are not predicted by 
theoretical analysis. (This analysis is presented in Chapter V.) Near the upper left comer of the high-cost area, 
for example, (see Frame 5 in Figure 14b) three straight homogeneous-behavior boundaries emanate from a 
point on the edge of the high-cost area: one is vertical, one is at a 45° angle, and one is horizontal. The latter 
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Example of Pure OPM Version of Wavefront Propagation 
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Figure 14b 

Example of Pure OPM Version of Wavefront Propagation 




two of these boundaries do not have analogues in die theoretical case, and the first, analogous to the "shadow" 
boundary expected at that vertex, is offset from the vertex of the high-cost area does not appear. 

Some spurious boundaries are generated because straight lines are being approximated by piece wise- 
linear curves in the eight allowable propagation directions. Several examples occur to the right of the high- 
cost area and to the left of the obstacle. Multiple parallel boundaries are generated by the upper-left edge of 
the obstacle, although all but the topmost boundary are spurious, while the two lower boundaries generated 
by the lower-left edge are both predicted by the analysis of Chapter V. The reason for the difference is that 
the lower-left edge is positioned at a 45° angle to the vertical, allowing a single straight path to lie along it. 
Thus the above boundary-detection heuristic does not detect spurious boundaries along the edge because there 
are no turn points on the path. But the upper-left edge lies at less than a 45° angle with the horizontal, and so 
the path along it must "stair-step" its way to the upper vertex, causing boundaries to be generated. A similar 
error occurs along the upper right and lower right edges of the high-cost area, where the stair-step nature of 
the edges causes spurious exterior boundaries to appear. Further spurious boundaries occur in the inside of the 
high-cost area, and outside it just above its rightmost vertex. 

Optimal-path maps generated by the pure wavefront propagation OPM algorithm will be useful if 
these spurious homogeneous-behavior boundaries do not matter. But there are approximately twice as many 
boundaries as are predicted by theoretical analysis, so storage and run-time speed are correspondingly less ef- 
ficient. 

2. The Diverging-Path Version of Wavefront-Propagation Optimal-Path-Map Construction 
Another approach is based on the idea that two adjacent cells whose paths diverge should be in dif- 
ferent regions, and so a boundary must exist between them. A way of detecting divergence of paths is to check 
the distance between the nth-generation ancestors of two adjacent cells. If the ancestors more than one cell 
apart, the cells are defined as diverging paths. In other words, we define the path-generalizing function so dial 
it maps cells to sets of paths which do not diverge. 

What should the value of n be? In other words, how far back along the paths of the two cells being 
compared should we check? If n is small, there will be fewer checks to perform, enhancing efficiency. If n is 
large some small terrain features may be overlooked by the divergence rule. On the other hand ifn is large, 
we can handle situations, such as boundary emanating from the obstacle in Figure 14b. Frame 5, where back- 
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paths may parallel each other for some distance before diverging. But this situation can be taken care of by 
adding a second condition which says that two cells are in different regions if their parents are in different 
regions. Even with this rule, however, if n = 1 , there are situations where the parents of two cells with diverg- 
ing paths are adjacent; choosing n = 2 seems to give the best results. An additional necessary heuristic is that 
two paths are in different regions if a cell between the two ancestors being checked is a terrain feature cell. 
This handles special cases such as very acute obstacle vertices, or paths on opposite sides of a river. Figure 15 
(on two pages) shows the result of applying these heuristics to wavefront propagation. We call this the diverg- 
ing -path version of die wavefront-propagadon OPM-generation algorithm. 

So there are three heuristics used in die diverging-path version. First, adjacent cells whose second- 
generation ancestors are more than one cell apart are in different regions. Second, adjacent cells are in dif- 
ferent regions if their parents are in different regions. Third, cells are in different regions if their 
second-generadon ancestors have a terrain-feature cell between them. 

This variant algorithm is not much better than the pure variant, as can be seen by studying Figure 
15b, Frame 5. Here too few boundaries are generated, and a few spurious boundaries appear as well. Those 
boundaries defined in Chapter V as opposite-edge boundaries, i.e., boundaries which distinguish between 
paths which go in opposite directions around a terrain feature, are the ones best detected by the diverging-path 
version. Shadow boundaries, i.e., boundaries which distinguish between paths which go through a terrain-fea- 
ture vertex from those wliich bypass it, are not detected at all. Spurious boundaries arise within homogeneous- 
cost areas. The homogeneous-cost area in Figure 15 has spurious boundaries just above its rightmost vertex. 
But for purely binary terrain, i.e., obstacles on a homogeneous-cost background, the diverging-path version 
may be appropriate. 

3. The Vertex-Edge Version of Wavefront-Propagation Optimal-Path-Map Construction 

Any variant algoritlun that relies solely on the turns in a path will misinterpret some turns as due to 
the terrain when in fact they were due only to the mechanics of the algorillim (e.g., the eight propagation direc- 
tions). and vice versa. Also, llie diverging-path variant only detects a certain class of boundary. A way to at- 
tack both of these problems is to plot boundaries based on how terrain-features affect optimal paths. 

In terrain with piecewise-linear edges in homogeneous-cost background, optimal paths will turn only 
at terrain feature vertices or edges (Theorem 1-2. Appendix A). Thus, if a turn in a path occurs at other than a 
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Figure 15b 

Example of Diverging-Path OFM Version of Wavefront Propagation 



vertex or edge, it must be turning based on algorithm mechanics alone. So we could check whether or not a 
turn point in a path is adjacent to a terrain- feature vertex or occurs at the edge of a bomogeneous-cost region. 
We could define the path-generalizing function as mapping a cell to a list of the terrain-feature vertices and 
edges at which its optimal path turns. We can say that a path turns at a vertex or edge if the turn cell is ad- 
jacent to or the same as the vertex or edge cell. 

This approach requires some additional terrain preprocessing. Since terrain in the two previous ver- 
sions has been represented entirely as individual cells, some way of finding and representing terrain- feature 
edges and vertices will become necessary. Such a preprocessing algorithm could group cells into terrain fea- 
tures of homogeneous cost, and then fit polygons to each feature. For each vertex of the polygon, it could find 
the closest corresponding cell in the original representation and label it as a vertex. For each edge of the 
polygon, it could find which cells most closely corresponded to it and label them as lying on that edge. Wade 
[Ref. 44] presents an algorithm for doing such terrain preprocessing. 

So we redefine "path list" to include only vertex and edge descriptors. To do this, turn cells are check- 
ed to see if they are adjacent to a terrain- feature vertex or edge. This procedure may create a spurious bound- 
ary if a path turns twice within one cell of a vertex, a case which would happen at a comer which formed a 
very acute angle, for example, a river end. In this case, a spurious boundary would he along the side of the 
river segment away from the start point. We must also specify from which side a path crosses an edge, be- 
cause a path may leave an area across an edge and then reenter it across the same edge. This type of path is il- 
lustrated in Figure 16b, Frame 4, starting at the cell labeled A. The path from A has a path list [A,C,D,G], 
while a path from cell B has a path list [C,D,G]. When comparing cells A and C (the first cells on the two 
paths) to determine if A and B have a boundary between them, we must be able to determine that the first path 
crosses our of the high-cost area at A, wliile the second path crosses into the area at C, and so the paths have 
different behavior. This set of heuristics provides the ability to detect boundaries inside homogeneous-cost 
areas, across rivers, and across roads. The procedures set-optimal-path-list and check-equivalent-paths arc 
listed in Table 2 with the appropriate changes. 

Figure 16 shows the above heuristics in operation. There is a very close correspondence between the 
boundaries of Figure 16b, Frame 5, and the theoretically correct boundaries for an exact optimal-path map. 
Few spurious boundaries are generated. For example, there arc too many boundaries emanating from the far 
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TABLE 2 



WAVEFRONT-PROPAGATION OPM ALGORITHM 
CHANGES FOR VERTEX-EDGE VERSION 



procedure set-optimal-path-list 
input: Cell 
{ 


/* REVISED PROCEDURE */ 


if (Parent of Cell is on Edgei and OPL-Parenl of 
Parent of Cell is not on Edgei) 

OPL-Parenl of Cell := Parent of Cell; 


/* include a cell in OPL for each boundary- */ 
/* crossing episode. */ 


else if (Parent of Cell is on line segment between 


/* SAME AS PREVIOUS VERSION */ 



Cell and OPL- Parent of Parent of Cell) 

OPL-Parent of Cell := OPL-Parenl of Parent of Cell; 
else 



OPL-Parent of Cell := Parent of Cell; 

} 


/* end of optimal-path-list */ 


procedure check-equivalent-paths 

input: OPLI, the OPL-Parent of Neighbor-Cell 


/* REVISED PROCEDURE */ 



and OPL2, the OPL-Parent of Current-Cell 
output: returns TRUE if paths are equivalent, FALSE otherwise. 

I 

if (OPLI = OPL2 = Igoal-point]) 
retum(TRUE): 
else 
{ 

for i = I to 2 



until ((first cell of OPLi is adjacent to 
a cell marked "vertex") or (first cell of 
OPLi is marked "edge/')) 

OPLi := OPLi less first cell: 
if ((first cell of OPLI = first cell of OPL2) 
or (first cell of OPLI is on the line 

between first and second cells of OPL2) 
or (first cell of OPL2 is on the line 

between first and second cells of OPLI) 


/* Consider only cells which are */ 

/* adjacent to terrain-feature vertices */ 
/* or represent edge-crossing episodes */ 
/* Paths are equivalent if each */ 

/* pair of cells are equivalent */ 


or ((edgei = edge/) and 

check-equivalent-pathstOPLl less first 
cell, OPL2 less first cell)) 

Bound arv-Flag := TRUE: 
else Boundary-Flag := FALSE: 

) 


/* NEW CONDITION */ 


I 


/* end of check-equivalent-paths */ 
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Example of Vertex-Edge OPM Version of Wavefiont Propagation 
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Example of Vertex-Edge OPM Version of Wavefront Propagation 
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right vertex of the high-cost area. And few boundaries are overlooked, although some shadow boundaries do 
not appear. For example, a shadow boundary should emanate from the lower right vertex of the obstacle; in 
Chapter V we develop analytic characterizations of homogeneous-behavior boundaries and find that the linear 
boundaries incident upon vertices should act as if they were shadows with the goal acting as a point light 
source. Also, the curved boundaries on tlie hidden side of obstacles should be hyperbolas, and the curved boun- 
daries inside homogeneous-cost areas should have monotonic curvature. From these comments, it can be seen 
that the boundaries generated by the vertex-edge version (as well as the other versions of wavefront propaga- 
tion) have some error in location and shape, although they may suffice for many applications. 

C. RECONSTRUCTING OPTIMAL PATHS FROM WAVEFRONT PROPAGATION 
OPTIMAL-PATH MAPS 

How can we reconstruct the optimal path from the start point knowing the node of the optimal-path tree 
which descibes its behavior? The answer depends on what information is available in the nodes, which will 
be different depending on the version of wavefront propagation, because homogeneous-behavior regions are 
defined differently for each version. For the pure or diverging-path version, each optimal-path-tree node rep- 
resents a single cell. Because intennediate turn cells on the portion of a path which lies within a homogeneous- 
behavior region are a result of the mechanics of the algorithm, and not of terrain-feature influence, a path can 
be approximated by plotting straight lines from a start cell to the cell of the node representing the region in 
which the start cell lies, another straight line from that cell to its parent in the optimal-path tree, and so on back 
to the goal. This type of path no longer confonns to the grid-based model; otherwise, some "stair-step" ap- 
proximation of the line would be required. By Theorem 1-2, in the type of terrain considered herein, paths are 
straight-line segments except at terrain- feature vertices or edges. So the vertex-edge version can use the above 
method for paths from start cells to nodes representing vertices, and between vertices. Between edges, further 
processing would be necessary to detemiine where along an edge a given path would cross using Snell's Law 
as discussed in Chapter II. 
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IV. ANALYSIS OF WAVEFRONT-PROPAGATION OPM-GENERATION 

ALGORITHMS 

A. SOURCES OF ERROR IN WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

A problem with using wavefront propagation to generate optimal-path maps is that the inherent error of 
the algorithm is carried forward to the OPM. As slated previously, Richbourg [Ref. 20] showed that an upper 
bound on the error factor of the cost of a model-optimal path generated by the point-to-point wavefront 
propagation algorithm compared with the cost of the corresponding real-world optimal path is cos(7l/8), or 
about 7.6%. The fact that tlie shapes of boundaries generated by wavefront propagation are only approxima- 
tions of the correct shapes derived in Chapter V reflects the error in the shape and cost of optimal paths in- 
herent in wavefront propagation. 

The optimal-path map in our approach does not retain information about all the intennediate cells where 
each path turns, and so we cannot reproduce the path exactly as generated by wavefront propagation. If we 
could, however, the upper bound on percent error of 7.6% would remain in effect, because notliing in the OPM 
algorithms of Chapter III affected how the wavefront expanded from cell to cell. The backpaths of Figures 14, 
15, and 16 are all identical (compare Frame 4 of each figure), and only tire boundaries differ. Although we 
cannot reconstruct a path exactly as generated by wavefront propagation, the straight-line approximation 
method proposed in Section C of Chapter III actually produces a path as good or better in cost than the 
wavefront propagation path. Straight-line approximations of a path always go through the region root, which 
was on the original path. They also he completely within an area of homogeneous cost, because homogeneous- 
behavior regions are star-shaped with respect to the region root (Corollary 1-1.4). By the triangle inequality, 
their cost is always less than or equal to the original path. So since costs of straight-line approximations are 
lower bounds on costs of wavefront-generated paths, the previously staled upper bound on percent error 
remains a valid upper bound. Can this upper bound be improved? 

Although in the case of most start cells, substantial improvement over the cost of model-optimal paths 
generated by wavefront propagation will be achieved by this path reconstruction method, the upper bound on 
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error cannot be tightened in general, because there will be situations where the error in placement of a bound- 
ary would cause a start point to be placed in an incorrect region, (although without exceeding the upper bound). 
An example of such a case occurs in Frame 5 of Figure 16, at the point labeled X. The optimal path from point 
X should be a straight line to the goal. But since wavefront propagation caused error in the placement of the 
vertical boundary (it should have been a "shadow boundary," a ray from the upper left vertex of the high-cost 
area extending directly away from the goal point), X is to the right of the vertical boundary instead of to its 
left, so it is associated with the region whose root is the top-left edge of the high-cost area. Thus, a reconstructed 
path will go in a straight line to the top of the high-cost area, and then cut across its comer and go the the goal. 
This path has a cost error close to the original upper bound. 

Thus the upper bound on percent error of the cost of wavefront-propagation-generated model-optimal 
paths with respect to real-world optimal paths remains as stated for the point-to-point version of the algorithm, 
i.e., 7.6%, although average error will be improved by appropriate reconstruction of paths from the optimal- 
path map. 

B. TIME COMPLEXITY OF WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

As stated in Chapter II, point-to-point wavefront propagation implemented using Dijkstra’s algorithm has 
worst-case time complexity 0(m log in), where there are m cells in the input map. In Algorithms B-l (Appen- 
dix B) and ID-1 (Chapter III), however, the algorithm is modelled on the wavefront analogy, and Dijkstra’s 
algorithm is not followed exactly (because cells may remain on the wavefront for more than one iteration, and 
a search for the minimum-cost edge is not done for each wavefront). As explained in Chapter II, the time com- 
plexity of this version is 0(c m), where c is the maximum cost of a cell in the input map, time is incremented 
by 1 unit each step, and it is assumed that there is some upper bound on the size of c. 

The mechanism for detecting boundaries is to check each cell on the wavefront against each of its eight 
neighbors. There are eight, or O(constant) checks for each of the m cells in the map. Each boundary check in 
the pure version consists of an O(constant) comparison of the first turn points on the backpaths of the two cells 
being checked. So bound ary -checking takes O(m) time. This is added to the time for the basic algorithm, so 
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the pure version of wavefront-propagation optirnal-path-map generation has the saine asymptotic w orst-case 
time complexity as point-to-point w avefront propagation, or 0(c m). 

In th ediverging-path version of wavefront-propagation optimal-path-map generation, the boundary check 
consists of a comparison of the distance between the parents of the parents of the two cells. Again it is an 
O(constant) operation to follow two back-pointers for each cell and compute a distance, so boundary-check- 
ing takes O(m) time, and the diverging-path version is also 0(c m). 

The vertex-edge version of wavefront-propagation optimal-path-map generation uses the same path lists 
as the pure version, but considers only so-called distinguished cells on the lists. A check of the first two dis- 
tinguished cells in a path list by procedure check-equivalent-paths will give a conclusive answer about 
whether or not two paths are "similarly behaved”. This check is an O(constant) process where the first element 
in each list is retrieved, and the two elements compared. So the vertex-edge version also has worst-case time 
complexity 0(c nt). 

As discussed in Chapter III, the vertex-edge version requires preprocessing of the terrain to fit groups of 
homogeneous-cost cells to polygons or line segments, and to find vertices and edges. The algorithm of Wade 
and Rowe [Ref. 44] which does this has two passes. The first pass processes each cell once, in total O(m) time. 
The second pass is recursive, and a worst-case time complexity is not given, but for a map with k edge cells, 
is approximately 0(log k). Under the above assumptions, the number of edge cells is significantly less than 
the number of cells, so k<m. Therefore the terrain preprocessing is dominated by the wavefront propagation 
algorithm . 

C. SPACE COMPLEXITY OF WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

The space required for the point-to-point wavefront propagation algorithm is simply O(m), where the 
input map has m cells. Storage is usually implemented by a Vrn by Vrn array which holds cost information 
and a pointer to the parent of the cell on its backpath. During execution, another data structure will hold the 
coordinates of those cells currently on the wavefront. When the algorithm is expanded to deal with the two- 
dimensional, or optirnal-path-map case, several new- data structures must be added. First, for the pure and the 
vertex-edge versions, two fields must be added to the cell array to hold the coordinates of the cell’s parent on 
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the optiinal-path list (in general not the cell's parent on the backpath). Secondly, new data structures must be 
added to hold the output. These data structures are the DCEL and the optimal-path tree. 

As explained in Chapter II, Section B, a doubly-connected edge list (DCEL) along with an optimal-path 
tree are well suited to representing the optimal-path map. The size of the optimal-path tree is proportional to 
the number of homogeneous-behavior regions in the optimal-path map, since there is one node per region. 
Since in the worst case there could be no more than one region per cell, the optimal-path tree will never re- 
quire more than O(m) storage. In fact as discussed above, the number of regions is assumed to be significant- 
ly larger than the number of cells, so the optimal-path tree will only require a small fraction of the total number 
of cells in the input map, and is more accurately a function of the number of terrain feature vertices and edges, 
or 0(v + e). 

The DCEL represents the planar partition by listing characteristics of each line segment, or edge, in the 
partition. Since each segment of the wavefront-propagation-OPM boundaries is designated as lying between 
two specified cells, there can never be more than O(m) boundary segments, and in fact, the one-dimensional 
nature of boundaries will tend to produce an DCEL of O(Vm) size. In tenns of terrain-feature vertices and 
edges, it is shown in Chapter V dial any given vertex or edge has a constant number of region boundaries as- 
sociated with it, so the DCEL will have size of 0(v + e). Note that the O(m) input map can be discarded after 
preprocessing, so the amount of storage needed at run-time will be 0(v + e). 

In practice, a great amount of storage can be saved in the way the planar partition is represented by the 
DCEL. As produced by the wave front -propagation OPM-generation algorithm, boundaries are represented by 
lists of cell edges (perhaps implemented simply by listing coordinates in the same coordinate system as the 
cells, but incremented or decremented by .5). But in fact, boundaries in the grid-based domain typically con- 
tain long, near-linear sequences, so the number of edges in the DCEL can be reduced greatly by representing 
only endpoints of such sequences. Figure 1 6 shows about half of the boundaries to be linear. 

D. EMPIRICAL PERFORMANCE OF WAVEFRONT-PROPAGATION OPM 
IMPLEMENTATIONS 

The three versions of the OPM-gcncralion algorithm described in Section B of Chapter 111 were imple- 
mented in Common Lisp on a Symbolics 3620 Lisp Machine. Although no special effort was made to make 
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these implementations efficient, some idea of the relative performance of the four versions, and some rough 
idea of the performance of wavefront propagation in general, can be gained by observing actual run-limes. 
Table 3 shows average elapsed times for two typical input maps, based on the Lisp function "get-universal- 
time". These real-time figures give some rough idea of the actual performance of these implementations. 
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TABLE 3 



WAVEFRONT-PROPAGATION OPM-GENERATION 
RELATIVE PERFORMANCE OF THREE VERSIONS 



MaD Number 


Pure PPM 
Version 


Divereing-Path 

Version 


Vertex-Edge 

Version 


1 

(average CPU Time) 
(average Real Time) 


449,759 cycles 
493 sec 


793,094 cycles 
843 sec 


2,292,827 cycles 
2,440 sec 


2 

(average CPU Time) 
(average Real Time) 


1.558,722 cycles 
1,714 sec 


916,535 cycles 
973 sec 


2,013,910 cycles 
2113 sec 



NOTES: 

(1) Average CPU Time is elapsed time as per machine-dependent LISP function "get-internal-run-time” 
averaged over eight runs. 

(2) Average Real Time is elapsed time as per LISP function "get-universal-time" averaged over eight runs. 

(3) Versions were implemented in Common-Lisp on a Symbolics™ 3640 operating under Genera 4.1™. 

(4) Map 1 was 199 by 150 cells (i.e., 29850), with one obstacle and one high-cost feature, 12 vertices and 
12 edges, with 465 cells, or 1.5%, of infinite cost (obstacle cells) and 741 cells, or 2.5%, of cost two. 

(5) Map 2 was 199 by 150 cells (i.e., 29850), with three obstacles, 15 vertices and 15 edges, with 619 cells, 
or 2.1%, of infinite cost. 
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V. CHARACTERIZATION OF REGION BOUNDARIES 



In this chapter, we formulate the geometrical groundwork necessary for an OPM construction algorithm 
which relies on spatial reasoning to eliminate much of the inaccuracy inherent in the wavefront propagation 
OPM construction algorithm. The algorithm applies to maps consisting of the five types of terrain defined in 
Chapter I, Section E, obstacles, roads, rivers, homogeneous-cost areas (HCA), and homogeneous-cost back- 
ground. The approach we use is to determine the analytic characteristics of boundaries between regions of 
similarly-behaved optimal paths as functions of terrain feature characteristics. It turns out that all boundaries 
associated with the first three of the above terrain feature types (roads, rivers, and obstacles) are segments of 
conic sections. Boundaries associated with HCA’s are more mathematically complex, and in many cases do 
not appear to have closed-form expressions. In addition to the algebraic form of these boundaries, we develop 
the theory which describes the circumstances in wliicheach type of boundary occurs. The algorithms described 
in Chapter VI will rely on the results developed in this chapter for the basic steps involving construction of 
each boundary. 

First , primitive terrain features, that is single polygonal obstacles and homogeneous-cost areas, and single 
river and road line segments, are studied and the boundaries they generate are characterized. Then a unifying 
theory is introduced which underlies all types of boundaries as they occurin terrain as defined herein. Develop- 
ment of algorithms for constructing OPM’s for each of the primitive terrain features and for combined terrain 
is deferred until Chapter VI. Appendix C contains additional examples of optimal-path maps for each of the 
primitive terrain features presented. 

A. REGION BOUNDARIES ASSOCIATED WITH PRIMITIVE TERRAIN FEATURES 

Table 4 summarizes the types of homogeneous-behavior-region boundaries associated with each type of 
primitive terrain feature. Each type of terrain feature is listed in the left column. The second, tliird, fourth, and 
fifth columns contain the names of the boundary types associated with that terrain feature which are linear, 
parabolic, hyperbolic, and non-conic respectively. Since there are four cases of homogeneous -cost area (HCA) 
depending on whether the goal is inside or outside the HCA and on whether the HCA cost is higher or lower 
than tire surrounding terrain, each of which has distinctively different boundaries, these four cases are listed 
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TABLE 4 



SUMMARY OF HOMOGENEOUS-BEHAVIOR-REGION 
BOUNDARIES BY TERRAIN TYPE 





LINEAR 


PARABOLIC 


HYPERBOLIC 


NON-CONIC 


Obstacle 


Shadow(c/c) 

Obstacle-edge 




Opposite-edge(c/c) 




River Segment 


Shadow(c/c) 

River-edge 




River-opposite-edge(c/c) 

River-crossing(c/c) 




Road Segment 


Road-edge 

Rd-end/road- 

tvlg(c/p) 

Rd-tvlg/road- 

crossing(p/c) 

Shadow(c/c) 


Near-side-road- 

travelling/goal(p/c) 

Far-side-road- 

travelling/goal(p/c) 


Road-end/goal(c/c) 




High-Cost 

Exterior-Goal 

HCA 


HCA-edge 
Hidden-edge/ 
merging-path(p/p) 
Hidden-edge/ 
diverging-patli(p/p ) 
Shadow(c/c) 


Opp-edge-O-thm- 

interior(c/c) 

Opp-edge-l-thm- 

interior(c/d) 

Opp-edge-2-thru 

interior(d/d) 


Visible-edge(d/d) 

Visible-hidden- 

edge(d/p) 

Comer- 

cutling(c/d) 


High- Cost 

Interior-Goal 

HCA 


HCA-edge Hidden-edge/goal(p/c) 

Shadow Visible-edge/goal(p/c) 

Hidden-edge(p/p) 
lnterior-opposite-edge(p/p) 


Exterior-opposite- 

edge(c/c) 


Comer-cutting 

(c/d) 

Visible-edge(d/d) 


Low-Cost 

Exterior-Goal 

HCA 


HCA-edge Edge-following/goal(p/c) Vertex/goal(c/c) 

Vertex/edge-following(c/p) 

Vertex-edge-crossing(c/d ) 


Edge-xing/(d/c) 

Opposite-edge(d/d) 

Visible-edge(d/d) 


Low-Cost 

Interior-Goal 

HCA 


HCA-edge 

Vertex/edge-crossing(c/d) 






Multiple- 
Connected 
River Segments 


Shadow(c/c) 

River-edge 




River-opposite -edge(c/c ) 
River-crossing(c/c) 
Near-side-river-crossing(c/c ) 



7 ? 



separately. Also listed with each boundary' name is a coded description of what type of cost functions are as- 
sociated with the homogeneous-behavior regions on either side of the boundary. The code "c" means the cost 
function of a region is conical, "p" means it is planar, and "d" means it is a "distorted cone". Terrain-feature 
edges always form boundaries, which of course are linear since terrain-feature edges are linear, but are not as- 
sociated with a particular cost function, so no code is shown. (See Section C for a discussion of cost functions.) 

1. Obstacles 

We begin by characterizing boundaries associated with a single obstacle in homogeneous-cost back- 
ground terrain (see Theorem V-l, Appendix A). (The types of boundaries associated with obstacles have pre- 
viously been determined by Mitchell [Ref. 4] using different terminology.) With respect to obstacles, define 
a visible edge to be an edge for which no point on the edge has an optimal-path list whose first element lies 
on the obstacle perimeter. Define a hidden edge as a non- visible edge, i.e., an edge for which some point on 
the edge has an optimal-path list whose first element lies on the obstacle perimeter. In the case of terrain con- 
taining only a single obstacle, this means that both visible-edge vertices are visible to the goal point. In Figure 
17, edges AB and BC are visible edges. Edges CD, DE, and EA are hidden edges. (Many of the following 
figures are similar in formal. Terrain features are shown as polygons or line segments. Homogeneous-behavior- 
region boundaries are shown as solid curves. Occasionally continuations of the boundaries are shown as dashed 
lines to clarify the form of a boundary. In many of the figures a field of small vectors represents the initial 
direction of the optimal paths from a sampling of start points. These fields are not part of the optimal-path 
map, but serve to illustrate the directions paths take and to corroborate the correctness of plotted boundaries.) 
Define an opposite edge to be the obstacle hidden edge for which the optimal path lists of neither vertex in- 
cludes the other. An isolated obstacle has exactly one opposite edge (Lemma V-l. 3, Appendix A). Edge DE 
is the opposite edge in Figure 17. A special case is that in which the role of the opposite edge is assumed by 
an obstacle vertex: this is ruled out by the general position assumption discussed in Chapter I, although the 
analysis for including such a case is a simple extension of the below. Define an opposite point as the point on 
the opposite edge with two distinct optimal paths, one llirough each vertex of the opposite edge. 

There are three types of boundaries associated with obstacles. Obstacle edges are trivial boundaries, 
since they separate regions whose optimal-path lists are [[J. goal-point] from regions with non-degenerate op- 
timal-path lists (see Lemma V-l.l ). Obstacle shadows emanate from vertices of hidden edges in a straight 
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Figure 17 
Obstacle 



15 



line, as if the goal were a point light source; each vertex of a hidden edge generates a shadow boundary For 
those vertices wliich join a hidden edge and a visible edge, the line segment lies on the line defined by the ver- 
tex and the goal; for those vertices which join two hidden edges, the line segment lies on the line defined by 
that vertex and the vertex of the hidden edge which is included in the first vertex’s optimal path. (See Figure 
17 and Lemma V-1.2, Appendix A). 

Each obstacle also has exactly one opposite-edge boundary wliich emanates from the opposite edge 
of an obstacle, and consists of segments of hyperbolas. This follows directly front the definition of a bound- 
ary by the application of basic analytical geometry (see Lemma V- 1 .4, Appendix A). The hyperbola is defined 
by considering the vertices Vj and V 2 of the opposite edge as foci. Choosing a coordinate system such that 
the x-axis intersects both foci and the origin is mid-way between them, Equation 1 describes the opposite-edge 
boundary. Forcing constant a to be positive restricts Equation 1 to the one branch of the hyperbola which is 
closer to the higher-cost focus. The segment of this branch which is active as a boundary begins at the point 
on the opposite edge intersected by the branch and continues away from the obstacle. (See Figure 17). 



(Equation 1) 



? 



b 2 



1 

cT 



where a = (IGV 2 I - IGVil)/2, IGV 2 l>IGVil, 
c = IV 1 V 2 l/2, and b 2 = c 2 - a 2 . 



If at any point the opposite-edge boundary intersects a shadow boundary, it will become defined by 
another hyperbola from that point on. This second hyperbola is defined by considering as foci (1) the vertex 
of the edge associated with the shadow boundary and which is the closer to the goal of the two vertices of that 
edge, and (2) the focus of the previous hyperbola which is not also a vertex of the edge associated with the 
shadow. The hyperbolic constant is computed as before, using the costs from the foci to the goal. The segment 
begins at the point where the second hyperbola intersects the first hyperbola, and continues away from the 
obstacle. The direction of curvature of the second hyperbola may be the same or opposite that of the first. (See 
Figure 17). 

2. River Segments 

Single isolated river segments generate four types of boundaries (see Figure 18 and Theorem V-2. 
Appendix A). River-edges are trivial boundaries (Lemma V-2.1). Shadow boundaries are associated with each 
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river vertex, and are half- lines starting at a river vertex and lying directly away from the goal (Lemma V-2.2). 
River-crossing boundaries differentiate between paths that cross a river and ones that go around its end. A 
river-crossing boundary is a segment of a hyperbola defined by considering the river vertex V and the goal G 
as foci, with the constant in Equation 1 being a = IVGI/2. The segment begins at the point at which the hyper- 
bola intersects the river and ends at the point at which it intersects the river-obstacle boundary (below). This 
type of boundary may not appear if the river-crossing cost is too high or if the angle between the river and the 
goal-to-river-end line approaches or exceeds 90°. (Lemma V-2.3). A river segment will act like an obstacle 
when the distance of the start point to the river plus the river-crossing cost is large compared with the distance 
from the river to the goal. If tliis occurs, a boundary will start at the intersection of the two river-crossing boun- 
daries, if they exist, or if not at the river edge. This opposite-edge boundary will be a hyperbola defined by the 
two river-end vertices V 1 and V 2 as in the obstacle opposite-edge case above. (Lemma V-2.4). The river shadow 
boundaries will never intersect the opposite -edge boundary, so it will consist of only one hyperbola segment. 

3. Road Segments 

Single isolated road segments are associated with various types of boundaries, depending on their 
orientation with respect to the goal (Theorem V-3, Appendix A). Consider a wedge with the goal G as the ver- 
tex, formed by extending two rays from G through the line of the road intersecting the line at two points A and 
B, so that tiie interior angles GAB and GBA are the angle y c = k/ 2—Q c , 0 c the critical angle such that 0 C = 
sin‘'(R/S), for R the road cost, and S the cross-country cost, where R is greater than S. Call this the charac- 
teristic wedge of the road segment. (See Figure 19.) We adopt the convention for the following discussion that 
the wedge intersection points A and B are labelled such that their relative positions on the road line are the 
same as the relative positions of the two road vertices V 1 and V 2 (e.g., if Vi is to the right of V 2 on a certain 
map, then A is to the right of B). When A and B and V 1 are arrayed along the road line in the order B,A,V 1 , 
(irrespective of V 2 S position), say that the characteristic wedge is inside Vi. When they are arrayed in the 
order B,Vi.A or when A and Vi are the same point, say that the wedge straddles V 1 . When they are arrayed 
in the order Vi,B,A, say that the wedge is outside Vi. There are seven types of boundaries induced by road 
segments, as listed below. When the characteristic wedge is inside Vi, types a,b,c, and d exist on the V,- end 
of the road segment. When the characteristic wedge straddles Vj, types a and g exist on the Vj end. When the 
characteristic wedge is outside Vi, types a.d, and f exist on the V ’2 end, and vice versa. When the characteris- 
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(c) Wedge is "outside" V ^and "inside" V 



(d) Wedge "straddles" V 2and is "inside" Vj 



Figuie 19 

Characteristic Wedges 



tic wedge is inside both V i and V 2 , type e also exists on each end. When the characteristic wedge is inside V 1 
and straddles V 2 , type e exists on the V 1 end only. Figure 20 and Figure 21 show two example road segments 
with their associated boundaries (labeled a). 

Type a: Road-edge boundaries separate paths which start on one side of a road from those which start 
on the other side. All road segments will constitute road-edge boundaries (Lemma V-3.1). For example, the 
road segment V 1 V 2 in Figure 20 is a road-edge boundary. 

Type b: Road-end! road-travelling boundaries separate paths which go to a road end and begin using 
the road from those wliich go to a road interior point and begin using the road. They are linear, and form a fan- 
shaped region at tlie road end. When the characteristic wedge is inside a road-end vertex V, there will be two 
road-end/road-travelling boundaries beginning at V and forming angles of K/2— 0 c and 0 C — 7t/2with the 

road. (Lemma V-3.2). Figure 20 shows four such boundaries (labeled b), two each emanating from road ver- 
tices V 1 and V 2 , because the characteristic wedge is inside both V 1 and V 2 . Figure 21 shows two road-end/road- 
travelling boundaries emanating from vertex V 2 , because the wedge is inside V 2 , but none from Vi because 
the wedge is outside V 1 . 

Type c: Road-end! goal boundaries separate paths which travel directly to the goal from paths that 
travel to a road end and then along the road. These boundaries are segments of hyperbolas where road-eud V 
and goal G are the foci, and the hyperbola is described by Equation 1, where Vi=G and V 2 =V. The boundary 
begins at the point where the hyperbola intersects the road-eud/road-travelling boundary. A road-end/goal 
boundary exists on the goal side of the road segment for vertex V 1 if and only if a pair of road-end/road-travell- 
ing boundaries exist; if the characteristic wedge is outside V 2 , a road-end/goal boundary will also exist on the 
far side of the road segment for vertex V|. (Lemma V-3.3). In Figure 20, two such boundaries exist (labeled 
c), one associated with each vertex of the road segment, and both on the goal side of the road, although the 
boundary on the V 2 end is not shown being off the page to the bottom. In Figure 2 1 , two such boundaries exist 
associated with V 2 , although both are off the page. 

Type d: Near-side road-travelling! goal boundaries lie on the near side of the road (i.e., on the goal 
side) and separate paths wliich enter a road interior, travel along it, and then exit the road to cut over to the 
goal from those which go directly to the goal. These boundaries are described by segments of parabolas defined 
for road-end vertex V 1 as follows: the focus of the parabola is the goal, G, and the directrix is the line perpen- 
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Initial Direction 
of Optimal Path 

Road Segment 

Boundary 



BOUNDARY TYPES: 

a- road-edge 
b- rd-end/rd-travel’g 
c - road-end/goal 
d- near-side-road- 
travelling/goal 
e- rd-tvlg/rd-crossing 
f - far-side-road- 
travelling/goal 
g- road-shadow 



Figure 20 

Road Segment Example 1 
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KEY: 

0 Goal 

Initial Direction 
of Optimal Path 

Road Segment 

Boundary 

BOUNDARY TYPES: 

a - road-edge 
b- rd-end/rd-travel’g 
c - road-end/goal 
d - near-side-road- 
travelling/goal 
e - rd-tvlg/rd-crossing 
f - far-side-road- 
travelling/goal 
g - road-shadow 



Figure 2 1 

Road Segment Example 2 
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dicular to the characteristic wedge ray GB and which intersects the ray GB, and is a distance IGAI from A if 
the characteristic wedge is inside Vj and not outside V2, and a distance IGV2I from V2 if the wedge is inside 
V 1 and outside V2. This parabola is described by Equation 2 , where the y-axis is the directrix and the x-axis is 
the axis of the parabola. 

(Equation 2 ) y 2 = 4 p x where p = d cos 2 ( 0 c )/4 

for d = IGAI if wedge not outside V2, 
and d = IGV il if wedge is outside V2. 

The segment of the parabola which is a boundary begins at point A if the characteristic wedge is in- 
side V| and not outside V2, and begins at point V 1 if the characteristic wedge is inside V 1 and outside V2. It 
ends at the point where the parabola intersects the near-side road-end/road-travelling boundary and the road- 
end/goal boundary if there is a road-end vertex, and continues indefinitely if there is not. It exists under the 
same conditions as these two exist. (Lemma V- 3 . 4 ). Figure 20 shows two near-side/road-travelling boundaries 
(labeled d), because the wedge is inside both V 1 and V2. The directrices Di and D2 are distances IGAI from A 
and IGBI from B respectively, because the wedge is inside both V 1 and V2. If the wedge had straddled either 
vertex, the same distances would continue to apply. Figure 21 shows one near-sidc/road-travelling boundary, 
but this one has a directrix (not shown) with a distance IGV il from V 1 because the wedge is outside V j. 

Type e: Road-travelling/road-crossing boundaries separate paths which begin on the far side of the 
road from the goal and travel along the road from those which also begin on the far side but cross the road and 
go directly to the goal. This type of boundary will exist for road-end V| when the characteristic wedge is in- 
side V 1 and not outside V2. It is linear (a ray), and is the portion of the characteristic wedge ray beginning at 
A and lying on the far side of the road. (Lemma V- 3 . 5 ). Figure 20 shows examples of two road-travelling/road- 
crossing boundaries which occur because the characteristic wedge is inside both vertices. Figure 2 1 has no such 
boundaries, because the wedge is outside V2. 

Type f: A far-side road-travelling/ goal boundary occurs on the V 1 end when the characteristic wedge 
is outside Vj. It is a segment of a parabola with focus G and directrix D such that D is perpendicular to the ray 
GA. but does not intersect it (i.e., D lies on the other side of G from A), and D2 is distance fV|GI from V|. This 
parabola is defined similarly to the one in Equation 2 . except that d=IV|GI. One far-side road-travelling/goal 
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boundary occurs in Figure 21 on the V 2 end of road segment because the characteristic wedge is outside V 2 . 
Non occurs in Figure 20, because the wedge is outside neither vertex. 

Type g: A road-shadow boundary' occurs when the characteristic edge straddles a vertex V. It separates 
points whose paths cross the road en route to the goal from those which go directly to the goal. The shadow 
boundary is a ray starting at V and lying directly away from G. (Lemma V-3.7). Note that since paths which 
cross roads pay no additional cost, tliis type of boundary occurs only by convention. We want path descriptions 
to reflect each terrain-feature-edge crossing, even though no change in direction or cost rate occurs for this 
case. This type is not illustrated in the accompanying figures. 

4. Homogeneous-Cost Areas (HCA) 

Homogeneous-cost areas (HCA) generate boundaries both inside and outside the HCA. The outside 
boundaries are similar, although not identical, to those associated with obstacles, rivers, and roads. This is not 
surprising, since the HCA is a generalization of each of these types of terrain. There are four cases, based on 
the relative costs of the HCA interior and exterior and the location of the goal inside or outside the HCA. We 
first consider the case where the cost of the interior of the HCA is greater than the cost of the exterior and the 
goal point lies outside the HCA, then the high-cost, interior-goal case, the low-cost exterior-goal case, and the 
low-cost interior-goal case. 

a. High-Cost HCA With An Exterior Goal 

When the goal is exterior to the homogeneous-cost area, and the cost of the HCA is greater than 
the surrounding terrain, boundaries occur according to Theorem V-4, Appendix A. Define a visible edge of an 
HCA to be an HCA edge for which no point on the edge has an optimal-path list whose first element lies on 
the HCA perimeter. Define a hidden edge as a non-visible edge, i.e., an edge for which some point on the edge 
has an optimal-path list whose first element lies on the HCA perimeter. Thus a hidden edge may have points 
whose optimal paths travel through the HCA, which would mean that their optimal paths would have as their 
first element the visible edge across which they pass. Define opposite-edge sequence as the smallest connected 
sequence of hidden edges for which the first and last endpoints of the edge sequence have optimal paths whose 
initial directions follow the HCA edges in opposite (i.e., clockwise versus counterclockwise) directions. If no 
such endpoint can be found at one end or the other of the sequence of hidden edges, let the endpoint at that end 
be the "outer" vertex of the last hidden edge. i.e.. the vertex which joins the last hidden edge in the clockw ise 
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(or counterclockwise; direction with the first visible edge in the clockwise (or counterclockwise ) direction. In 
Figure 22, the initial direction of optimal paths for each edge endpoint is shown as a vector. HCA 1 has op- 
posite-edge sequence ED, HCA 2 has opposite-edge sequence EDCB, HCA 3 has opposite-edge sequence 
FED, and HCA 4 has opposite-edge sequence JIHFE. Essentially, this definition specifies the range over which 
a search must be conducted for an opposite point, if one exists, and defines the HCA vertices which may 
generate opposite-edge boundaries (see below). Define the opposite point of an HCA as a point with two op- 
timal paths lying in opposite directions (i.e., clockwise and counterclockwise) along HCA edges. If "shortcut- 
ting" occurs through the center of HCA, the opposite point might not exist, as in HCA 2 and HCA 3 of Figure 
22 . 

Define the critical angle 9 C of an HCA as sin’^cifo) where the ci are the unit costs inside and 
outside the HCA, and ci > C 2 - An optimal path crossing an HCA edge will obey an analogue of Snell’s Law 
in optics [Ref. 20] (see Chapter II, Section E) so that for angle of incidence 0i and angle of refraction 02, 
and cost rates ci and C 2 on either side of the edge, ci sin(0i) = C2sin(02). (See also Chapter II, Section 
E2b(3) and Figure II-8). 

Inside a high-cost HCA with external goal, there are four types of boundaries (See Figures 23, 
24, and 25). Each pair of HCA edges is potentially associated with an interior boundary. The boundary type 
depends on whether the edges are visible or hidden, and are on the same or opposite sides of the opposite-edge 
boundary. A visible-edge boundary distinguishes optimal paths which go through two different visible edges: 
the optimal paths cross their respective edges according to Snell’s Law. Lemma V-4.1 (Appendix A) states 
the analytic form of such a boundary. Although not expressible in closed form, the boundary’ has much the 
same shape as a hyperbola segment wliich forms an obstacle opposite-edge boundary, i.e, it has positive but 
decreasing curvature from its point of incidence upon an HCA vertex inward into the HCA, and this curva- 
ture is typically small so that the curve is almost linear. An example of a visible-edge boundary is found in 
Figure 23, labeled a. 

A visible-hidden-edge boundary distinguishes optimal paths going through a visible edge from 
those going through a hidden edge; the latter paths traverse the HCA edge at exactly the critical angle and the 
follow the edge. Lemma V-4.2 states the analytic form of tlvis type of boundary, which again is similar to a 
hyperbola. Examples of this type of boundary occur in Figures 23, 24, and 25 and arc labeled b. 
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BOUNDARY TYPES: 



visible-edge 

visible/hidden-edge 

hidden-edge-mcrging-path 
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f - opposite-edge 
g - corner-cutting 




Eiguie 23 



High-Cost, Extei ior-Goal HCA Example 1 
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Figure 25 

High-Cost, Exterior-Goal HCA Example 3 









A hidden-edge merging-path boundary distinguishes optimal paths leaving the HCA at two dif- 
ferent hidden edges at exactly the critical angle, and for which all paths merge before the goal. A way to check 
for this behavior is to see if an optimal path from a vertex of one of the edges includes a vertex of the other 
edge. Lemma V-4.3 states the analytic form of this type of boundary, which is a line segment. The boundaries 
labeled c in Figures 23, 24, and 25 are hidden-edge merging-path boundaries. A hidden-edge diverging-path 
boundary is like the preceding except the two classes of paths merge only at the goal. This type of boundary 
is also a line segment, as stated in Lemma V-4.4. Examples of this type of boundary occur in Figures 24 and 
25 and are labeled d. 

Each pair of adjacent edges is always associated with one of the above interior boundaries, while 
non-adjacent edges may or may not be. If short cutting does not occur across an HCA comer, a boundary will 
start at the vertex at that comer. If shortcutting does occur, the boundary associated with that vertex will in- 
tersect the HCA edge at the point where shortcutting starts (see Figure 23 where two of the boundaries labeled 
b intersect the opposite edge, Figure 24 where one of the boundaries labeled b intersects the lower right edge 
of the HCA, and Lemma V-4.5). From the vertex or shortcutling point at which such a boundary begins, it will 
continue into the HCA interior until it intersects another boundary or HCA edge. At the point at which two 
such boundaries first intersect they will terminate, and a third boundary will begin which represents the division 
between the two regions which the first two boundaries did not have in common. For example, in Figure 23 
the boundary associated with vertex Vj distinguishes paths which cross edge V 1 V 2 from those which travel 
along edge V 1 V 5 , while the boundary associated with vertex V 5 distinguishes those which travel along edge 
V 1 V 5 from those winch travel along edge V 4 V 5 passing through vertex V 5 . These two boundaries begin at 
their respective vertices and intersect in the HCA interior, and from that point a third boundary begins which 
distinguishes paths which cross edge V 1 V 2 from those which travel along edge V 4 V 5 passing through vertex 
V 5 . These two descriptions ("crossing V 1 V 2 " and "travelling along V 4 V 5 through V 5 ") represent the two 
regions which the initial boundaries did not have in common, so they characterize the third boundary. Boun- 
daries will continue to intersect and new ones begin in the HCA interior until the boundary' associated with 
each visible vertex is joined with one or more hidden vertices or HCA edges (Lemmas V- 4.10 and V-4.1 1 ). 

These networks of boundaries can be represented as trees, where each boundary is considered a node, and 
edges connect nodes whose boundaries intersect (see Lemma V-4.10). Such a tree, called an interior-bound- 
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ary tree, has interior nodes with exactly two children, while the root of such a tree can have zero, two, or four 
cliildren. A tree whose root and sole node has zero cliildren represents a boundary which goes front one edge 
of the HCA to another without intersecting any other boundaries, such as the boundary emanating from ver- 
tex V 2 in Figure 23. A boundary’ separates two regions, and any time two boundaries intersect it must be, as 
explained above, that they have one of the two regions in common. Beyond the point of intersection, the two 
regions they did not have in common must be separated by a boundary’. Thus each lime two boundaries inter- 
sect, a third must begin. We choose as leaf nodes those boundaries associated with HCA vertices, because one 
of these boundaries is guaranteed to exist for each vertex, and no other interior boundaries intersect it at the 
vertex or edge, so we can be sure that they will have no cliildren. At the other end of such a boundary it either 
intersects an HCA edge, meaning its node is a root without children as described above, or it intersects two 
other boundaries, one of which will also be associated with an HCA vertex and so be another leaf node. If the 
latter is true, the boundary beginnning at the intersection point of the two leaf- node boundaries will serve as 
the parent node of the two boundaries. This merging of boundaries will continue until the parent node’s bound- 
ary intersects an HCA edge, in which case the node is the tree’s root, or until roots of two boundary trees are 
found to represent the same boundary’, in wliich case the two trees can be merged into one. This is the case 
where a root will have four cliildren, representing the two boundaries which intersect each end of the root’s 
boundary. Several examples and illustrations of the construction of such interior-boundary trees are given in 
Chapter VI. 

Outside the HCA. there are four types of boundaries Again, HCA edges are trivial boundaries 
(Lemma V-4.5 ). HCA shadows are defined exactly as for obstacles (Lemma V-4.6). Examples of HCA shadow 
boundaries are labeled e in Figures 23, 24, and 25. The other two types are HCA opposite-edge boundaries 
and HCA corner-cutting boundaries. HCA opposite-edge boundaries are the generalization of obstacle op- 
posite-edge boundaries, and differentiate between paths which start outside the HCA and go through or around 
the HCA in different directions. There are three types of opposite-edge boundaries, depending on whether 
neither, one, or both optimal paths go through an HCA edge. A path which does not go through the HCA goes 
around it initially via one of its vertices. The case where neither path goes tlirough the HCA is the same as the 
obstacle opposite-edge boundary case, and is described by connected hypeibola segments. The Drst and second 
cases have more complicated analytic forms, although the shape of the boundaries is very similar to hyper- 
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bolas. (Lenmia V-4.7). In Figures 23, 24, and 25, opposite-edge boundaries are labeled f. In Figures 23 and 
24 all three cases occur, while in Figure 25 the HCA is a virtual obstacle, that is, it appears to points outside 
it that it is an obstacle, so the only opposite-edge boundary it has is the third, or hyperbolic case. 

HCA Comer-cutting boundaries occur when optimal paths cut into the HCA along an edge which 
is not part of the opposite-edge sequence. In fact, the analytic form of this boundary is just a variation of the 
second of the three types of opposite-edge boundaries discussed in the previous paragraph. Comer-cutting 
boundaries emanate from a vertex connecting a hidden and a visible edge when shortcutting occurs across 
those edges (for example, in Figure 24, labeled g). In the generalization of this case where the edges across 
wliich shorlcutting occurs are separated by one or more edges, the comer-cutting boundary begins at the point 
at which the set of interior boundaries intersects the liidden edge (Lemma V-4.8). 

The construction of interior-boundary trees is useful in finding exterior boundaries. There is ex- 
actly one opposite-edge or comer-cutting boundaiy associated with each interior tree of boundaries, and each 
visible HCA vertex is connected, either directly or via its interior boundary tree, to an opposite-edge or comer- 
cutting boundary. (Lemma V-4. 1 1 ). When an interior boundary tree includes as a leaf node an interior hidden- 
edge-diverging-path boundary, the point at which the boundary intersects the HCA edge is connected with an 
exterior opposite-edge boundary. When an interior-boundary tree includes as a leaf node a point of intersec- 
tion of an interior boundary' and an HCA edge, but does not include an opposite point, for example, as hap- 
pens three times along the hidden edge of the HCA in Figure 23, this point of intersection is connected with 
an exterior opposite-edge or comer-cutting boundary. When as happens to the rightmost vertex in Figure 24, 
a vertex is not connected with any interior boundary tree, comer short cutting occurs and a comer-cutting bound- 
ary is connected with the comer vertex. Two HCA opposite-edge boundaries or comer-cutting boundaries may 
intersect each other or a shadow boundary, and if they do a third boundary begins at the point of intersection 
and lies aw'ay from the goal, as in the case of obstacle opposite-edges. 

An optimal path will travel into a liigh-cost HCA from outside it only across an edge wliich forms 
an angle greater than sin"'(20c) with another connected HCA edge [Ref. 20]. If none of the hidden edges are 
associated with included angles of less than 20 c with connected visible edges and the cost ratio and dimen- 
sions of the HCA allow, it acts exactly as an obstacle with respect to all start-points outside the HCA. Such an 
HCA is called a virtual obstacle. The HCA shown in Figure 25 is a virtual obstacle. If all the opposite-edge 



92 



and comer-cutting boundaries converge and become a single opposite-edge boundary away from the goal, the 
HCA becomes, for all points beyond the point of convergence, a virtual obstacle. 

b. High-Cost HCA With An Interior Goal 

An HCA containing the goal point and with higher cost than the surrounding terrain generates a 
set of exterior boundaries similar to the high-cost exterior-goal case, while the interior boundaries are reminis- 
cent of road boundaries. The similarity to road boundaries arises because for start -points inside the HCA, it 
may be profitable to move away from the goal point initially in order to travel along an HCA edge in the ex- 
terior, lower-cost region, just as if there were a road segment along the HCA edge. Figure 26 illustrates the 
high-cost interior-goal case (see Theorem V-5). 

We will define edges for lliis case with respect to each of its vertices, so that an edge may be 
defined differently for each of its endpoints. Define a visible edge with respect to one of its vertices V as an 
edge for which the optimal path from V cuts into the HCA interior at some point along the edge (either im- 
mediately from V or along the edge interior). Define a hidden edge with respect to V as an edge for which the 
optimal path from V starts along the other edge incident to V, or for which no optimal path from any point on 
the edge cuts directly into the HCA interior. Define an opposite edge as an edge which is a hidden edge with 
respect to both its vertices. There are four types of interior boundaries, wliich are line segments and parabola 
segments. Each HCA vertex can generate a set of boundaries. For each vertex V, if the optimal-path from that 
vertex consists only of the goal point, i.e, if the optimal path from the vertex goes directly to the goal, then 
there are no interior boundaries associated with that vertex. 

If on the oilier hand the optimal path from HCA vertex V travels initially along an HCA edge, 
call the edge along which the path travels initially E 2 , and call the other HCA edge incident upon V (along 
which the path does not travel) E|. In this case there will be a boundary' associated with vertex V which is a 
line segment. This boundary starts at V and separates paths which cut over to edge E| and go through V from 
those which cut over to edge E 2 , bypassing V. This is a hidden-edge boundary as defined for the exterior-goal 
case above. (In Figure 26, boundaries labelled a are hidden-edge boundaries. Also see Lemma V-5.1 in Ap- 
pendix A). In this case there will also be a parabolic boundary called a hidden-edge/goal boundary, which 
separates optimal paths which go directly to the goal from those which go initially away from the goal to edge 
Ei and from there through V and on around the HCA, cutting back in to the goal at another point on the HCA 
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perimeter. Tliis parabola is formed by considering the goal point as the focus, and constructing the directrix, 
such that it is perpendicular to a line from V into the HCA exterior which forms an angle of Tt/2 + 0 C with 
edge Ej , and such that it is a distance d from V where d = cost(optimal path from V)/c i , where c i = exterior 
cost. (See the boundaries in Figure 26 labeled b, and Lemma V-5.2, Appendix A.) 

If in addition, the first turn point P on the optimal path from V is an interior point of edge E 2 , 
i.e., if the second leg of the optimal path from V cuts into tlie HCA to the goal, there will be a boundary called 
a visible-edge! goal boundary associated with V and edge E 2 which separates paths that go directly to the goal 
from those which go initially back to E 2 then travel along E 2 to P, and then cut into the HCA at P to tire goal. 
The visible-edge/goal boundary intersects the HCA edge at P. Again, the focus is the goal point, and in this 
case the directrix is perpendicular to a line from P into the HCA exterior which forms an angle with line seg- 
ment PV of 7t/2 4- 0c, and which is distance d from P such that d = cost(OPL(P))/c i . (See Figure 26, the boun- 
daries labeled c, and Lemma V-5.3.) 

The other type of interior boundary occurs when two adjacent vertices on a hidden edge have 
optimal paths which both lie initially on an HCA edge, but which go in opposite directions around the HCA 
(i.e., for which neither optimal path includes the other vertex). This is the same situation that occurs in the 
definition of an obstacle opposite-edge, and so such an edge is called an HCA opposite edge. However, there 
may be zero, one, or more opposite edges in this case. Each HCA opposite edge V JV 2 generates an interior 
opposite-edge boundary, which separates paths which exit the HCA and go through vertex V 1 from those 
which exit and go through vertex V 2 . (See Figure 26, the boundary labeled c, and Lemma V-5.4.) 

The exterior boundaries in tliis case are quite similar to the high-cost exterior-goal HCA case. 
There are five types of exterior boundaries. HCA edges are trivial boundaries (Lemma V-5.5). Shadow boun- 
daries are associated with each vertex V whose optimal path OPL(V) includes as its first path- vertex a point 
P on the HCA perimeter. The shadow boundary is constructed by extending a ray from V along line VP away 
from P. (See Figure 26, boundaries labeled e. and Lemma V-5.6.) 

Opposite-edge boundaries emanate from each HCA opposite edge. An opposite-edge boundary 
begins at an opposite point with a hyperbola segment and extends outward from the HCA. being formed ex- 
actly as in the exterior-goal case. Since then? may be more than one opposite edge, there may also be more 
than one opposite-edge boundary. (See Figure 26. boundaries labeled f and Lemma V-5.7. ) Visible-edge boun- 



95 



daries separate paths which cross two edges en route to the goal. This type of boundary exists whenever an 
optimal path from an HCA vertex goes directly to the goal. The boundary starts at the vertex and lies outward, 
possibly terminating when it intersects the next kind of boundary. (See boundary labeled g in Figure 26, and 
Lemma V-5.8.) Corner-culling boundaries e manate from points at which hidden-edge/goal boundaries from 
the interior intersect the HCA edge. They separate points whose optimal paths cross tire edge front those which 
go around the edge vertex. These boundaries begin at the HCA edge and are concatenated with new curve seg- 
ments at each point at which the earlier curve intersects a shadow boundary, as in the comer-cutting case above. 
(See boundaries labeled h in Figure 26, and Lemma V-5.9.) 

c. Low-Cost HCA With An Interior Goal 

Analysis of an HCA with lower cost than the surrounding terrain, where the goal is in the HCA 
interior, shows a much simpler set of boundaries (Theorem V-6). There will never be any boundaries inside 
the HCA in tliis case, because there is no incentive for an optimal path to move away from the goal to the high- 
cost, external terrain, and there are no terrain-feature edges or vertices between any point in the HCA and the 
goal, since our HCA’s are assumed convex. (See Lemma V-6. 1, Appendix A.) External boundaries will occur 
inpairs, forming a wedge emanating from each vertex of the HCA, much as in the case of road-end/road travell- 
ing boundaries for a road segment. The external boundaries are all rays which begin at an HCA vertex and lie 
away from the goal, and can be constructed by tracing a path from the goal to the vertex, and then employing 
Snell’s Law for the path with respect to each of the edges incident to the vertex to determine the orientation 
of the two boundaries. Call this type of boundary a vertex! edge-crossing boundary (see Lemma V-6.2). Figure 
27 shows a low-cost HCA with interior goal, and the boundaries it induces on the plane. 

d. Low-Cost HCA With An Exterior Goal 

The final case, where the cost inside the HCA is lower than the surrounding terrain and the goal 
is outside the HCA, bears some similarities to the low-cost, interior-goal case and some to the high-cost, inte- 
rior-goal case. In this case, parabolic and similar boundaries occur outside the HCA, treating HCA edges as 
if they were roads, and the wedges which occur in the low-cost, interior-goal case are present in this case as 
well. Only one type of boundary occurs in the HCA interior, and seven types occur in the HCA exterior 
(Theorem V-7). Figure 28 illustrates a typical low-cost, exterior-goal HCA. 
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Figure 27 
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In the exterior, in addition to the trivial edge- boundaries (Lemma V-7. 1), boundaries can be con- 
structed by considering the behavior of the optimal path from each of the HCA vertices. For each vertex V of 
the HCA, let Ei and E 2 be the edges incident upon V, while Vi and V 2 are the vertices such that Wi = Ei 
and W 2 = E 2 . Additionally, let vertex Vj be closer to the goal than vertex V 2 , i.e., the cost of the optimal 
path from Vi be less than the cost of the optimal path from V 2 . 

If the optimal path from V goes initially along HCA edge Ei, (note that it will not go along E 2 
because of the naming convention above), the paths treat the edge somewhat as if it were a road. Let P be the 
first point on the optimal path from V, which will be the point at which the path exits the HCA interior toward 
the goal. A reri exledge-following boundary and a vertex/edge-crossing boundary are associated with from V 
with respect to edges Ei and E 2 respectively. The vertex/edge-crossing boundary is a ray with vertex V lying 
in the HCA exterior such that the ray and the first leg of the optimal path from V form a Snell’s-Law crossing 
of HCA edge E 2 (see Lemma V-7. 2). This type of boundary separates paths which go to vertex V and then 
along edge Ei from those that go directly to Ei and follow along it. The vertex/edge-following boundary is a 
special case of the vertex/edge-crossing boundary where the Snell’s-Law angle of the ray with edge Ei is the 
critical angle 0 C (see Lemma V-7. 3). These boundaries are labeled 1 in Figure 28. The vertex/edge-crossing 
boundary separates paths which go to a vertex V and then cut into the HCA interior from those that cross edge 
Ei into die interior. In Figure 28, these boundaries are labeled 2. 

Also occurring is an edge-following/ goal boundary which is a parabola with the goal point as 
focus and directrix perpendicular to a line from P at an angle 7t/2 + 0 C , lying a distance d away from P where 
d is the cost of an optimal path from P. This type of boundary separates paths which go to edge Ei and follow 
the edge from those which go directly to the goal. (See Lemma V-7 .4) Figure 28 has these type of boundaries 
labeled 4. Additionally, a vertex/goal boundary occurs which is similar to the road-end/goal boundary of the 
road segment case. This boundary begins at the point at which the edge-following/goal boundary intersects 
the vertex/edge-following boundary, and is a hyperbola segment with V and G being the foci, and the hyper- 
bolic constant being the cost of the optimal path from V (see Lemma V-7.5). Figure 28 labels this type of 
boundary 3. This boundary may continue indefinitely, or it may intersect the vertex/edge-crossing boundary 
emanating from V. If these two intersect, both terminate at the point of intersection and a third boundary dis- 
cussed below begins. 
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Key to Bdry Types: 

1 - vertex/edge-following (line) 

2 - vertex/edge-crossing (line) 

3 - vertex/goal (hyperbola) 

4 - edge-fol lowing/goal (parabola) 

5 - edge-crossing/goal 

(distorted hyperbola) 

6 - visible-edge (distorted 

hyperbola ) 

7 - opposite-edge (distorted 

hyperbola ) 
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Figure 28 

Low-Cost, Exterior-Goal HCA 
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For each HCA vertex V for which the optimal path from V goes initially into the HCA interior, 
a pair of linear vertex/edge-crossing boundaries will occur, just as in the interior-goal, low-cost case. These 
boundaries separate points whose optimal paths enter the HCA through a hidden vertex from those which enter 
through a hidden edge. Each boundary is constructed by extending a ray from V into the HCA exterior such 
that the ray and die first leg of the optimal path from V fonn a Snell’s-Law crossing of Ei and E 2 respective- 
ly. If in addition the vertex/goal boundary' associated with vertex V 1 intersects the vertex/edge-crossing bound- 
ary emanating from V 1 associated with edge Ei, a third boundary begins. If the first point P along the optimal 
path from V is an HCA vertex, the boundary will be an edge-following/goal boundary, a parabola, as discussed 
above. If P is an interior point of an HCA edge, the boundary will a more general type of curve similar in shape 
to a parabola, called an edge-crossing/goal boundary (see Lemma V-7.6) In Figure 28, these type of boun- 
daries are labeled 5. A vertex/goal boundary also occurs, beginning at the point at which the edge-crossing/goal 
boundary intersects the vertex/edge-crossing (or edge-following) boundary associated with edge Ei . 
Whenever an interior boundary (see below) intersects a hidden edge of the HCA, an exterior boundary begins, 
called an opposite-edge boundary (see Lemma V-7.8 and Figure 28 boundary labeled 7). Opposite -edge boun- 
daries separate paths which cross an edge into the HCA interior and then go across the HCA to exit across a 
second, visible edge, from those which cross the same first edge into the HCA but exit across a third, visible 
edge. Just as in the high-cost, exterior-goal case, these boundaries may intersect and new opposite-edge boun- 
daries begin, but in this case they are of only one type and separate paths which cross one pair of edges from 
those which cross another pair. 

There is only one type of boundary in the interior of a low-cost, exterior-goal HCA. It begins at 
a visible vertex wliich is not directly connected to any other boundaries, and separates points whose optimal 
paths cross one visible edge incident to the vertex from those which cross the other visible edge. Because of 
its similar boundary type in the high-cost exterior-goal case, it is called a visible-edge boundary (see Lemma 
V-7.7 and the boundary' labeled 6 in Figure 28). Just as in that case, the interior boundaries may intersect and 
generate new boundaries, which are also visible-edge boundaries. Whenever a visible-edge boundary' inter- 
sects a liidden edge, the visible-edge boundary terminates and an opposite-edge boundary' begins in the HCA 
exterior. Both the visible-edge boundary and the opposite-edge boundary types are similar in shape to hyper- 
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bola segments, although their algebraic form is not expressible in closed form. These boundaries typically 
have very little curvature. 

B. A UNIFYING VIEW OF REGION BOUNDARIES 

The boundaries associated with each terrain feature and the homogeneous-behavior regions they separate 
can be viewed in a more unified manner. This view will provide the basis for a key step in the algorithm 
presented in Chapter VI which merges optimal-path maps for isolated terrain features into consolidated op- 
timal-path maps. 

1. Cost Functions of Regions With Respect to Region Roots 

The cost of optimal paths from each start point in tlie plane is a function of the location of the start 
point. In other words, there is a cost function of X and Y which characterizes the entire map. Consider the 
region in the vicinity of the goal, for which the goal is the region root. Cost is proportional to distance from 
the goal, in the absence of intervening terrain, so iso-cost contours form circles about tlie goal. This cost func- 
tion is an inverted cone with vertex at tlie goal-point, or the upper half of a cone as defined in classical geometry. 
In any homogeneous-behavior region with a point as its root, there will be some additional cost of tlie optimal 
path from the root to the goal. For each region whose root is a single point then, the cost function in the region 
will be conical with respect to a vertical axis through the point. The vertex of the cone representing the cost 
function will be shifted upward on the cost axis by the amount of the cost of an optimal path from tlie root. 

Another type of region root is an edge along which paths travel en route to the goal, for example, a 
road segment (see Figure 29). In the discussion above regarding road segments, it was noted that the path from 
a point whose optimal path enters a road to travel along it does so at the critical angle 9 C = sin" '(C r /Cb). 
where C r is the cost of travelling a unit distance by road and Cb is the cost of travelling a unit distance in back- 
ground terrain. Also, therefore, the cost of travelling from the point of entrance onto the road Pe to the point 
of exit from the road Px is C r IPEPxl = Cbsin(9 c )IPEPxl. 

Tlie cost of travelling from point S to the road and along the road to the point of exit Px is then ISPElCb 
+ !PEPxlCbsin(9 c ) = CbdSPrJ + IPEVxlsin(9i ,». Consider a right triangle with hypotenuse PePx. with one leg 
a continuation of SPe to the other side of tlie road from S to point Q. Now IPeQI = IPEPxlsin(9b), so the cost 
of travelling from S to Pe and along tlie road to Px is Cb(ISPEl + IPeQI ) = CbISQI since S. Pe, and Q are colinear. 
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Figure 29 

Cost Function for Road Segment 
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Thus, the cost from any point S to move to a road and travel along it to some point Px is proportional to the 
distance from S to a line at angle 9 C with the road and passing through Px. But by this description, S describes 
a plane which intersects line QPx lying in the plane of the map, such that the slope of the plane in the gradient 
direction is CbISQI/ISQI = Cb. So the cost function associated with a length-wise-travelled edge is a plane. 

A third type of region root is an edge which paths cross, obeying Snell’s Law as they do so. As each 
path crosses the edge, it enters a region where the cost function becomes proportionally greater or less than 
before. But each edge which is crossed according to Snell’s Law perfonns a transformation on the current cost 
function, or intuitively speaking, distorts the cost function. The cost function associated with a Snell ’s-Law 
edge is therefore a distortion of the cost function associated with the parent of the edge in the optimal-path 
tree. Thus there are two cost functions associated with Snell’s-Law edges, one where the cone of a point-type 
root is transformed by the edge resulting in a distorted cone, and one where the plane of a road-type root is 
transformed by the edge, resulting in a plane. For regions with conical cost functions, paths which crossed into 
it from a region with a lower cost would have a cost function which was a flattened "cone". Paths crossing into 
it from a region with a higher cost would have a cost function which was a "cone" with greater curvature. For 
regions with planar cost functions, higher-cost adjacent regions would have a more sloped cost function, while 
lower-cost adjacent regions would have a less sloped cost function. 

There are any number of "higher-order” cost functions associated with Snell’s-Law edges ending in 
a point. For example, paths could cross three edges enroute to a point. So it does not appear to be possible to 
derive a finite number of analytic characterizations of cost functions for all varieties of Snell’s-Law edges. 
Note, however, that although a cost function may be transformed by any number of Snell’s-Law edges, it has 
its basis in either a point or a linearly-traversed edge root, so there are really only two general classifications 
of Snell’s-Law cost functions, those for n crossings rooted in a point, and those for n crossings rooted in a 
linearly-traversed edge. Once a sequence of region roots leads back to a point or a traversed edge, a fixed cost 
is associated with the point or the goal end of the edge, which is the cost from that point to the goal, and so no 
other previous information about cost functions remains relevant. 

A river edge can also be a region root. However, since a river edge only adds a fixed amount to the 
cost of paths which cross it, it serves only to shift vertically by a fixed amount whatever cost function occurs 
in the region on its near side, and so cannot be said to have a characteristic cost function of its own. The final 
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lype of region root is the degenerate one, the null list, adopted by convention to represent regions winch have 
no feasible paths, for example, obstacle interims. Since the cost of a path in the degenerate region is infinity, 
Che cost function will be considered undefined. 

Since these are the only types of region roots which occur in the terrain defined for this research, 
there are only three general types of cost functions : cones , planes, and various orders of distorted cones, depend- 
ing respectively on wliether the region has a point as its root, a linearly-traversed-edge or one or more Snell ’s- 
Law edges ending in a linearly-traversed edge as its root, or finally a Snell ’s-Law edge as its root leading to 
one or more Snell ’s-Law edges and a point. 

2. Boundaries Between Regions as Intersections of Cost Functions 

The occurrence of many of the simpler types of boundaries can now be explained in terms of the cost 
functions of the region roots for regions which the boundary separates. Since at a boundary between two 
regions, the cost function for both regions applies, it must be that the boundary is the projection on the XY 
plane of the intersection of the two cost functions. The intersection of two cones with parallel axes is, accord- 
ing to basic analytic geometry, a hyperbola, and so it becomes clear why the boundary between two regions 
with points as roots is always a hyperbola. 

The boundary between a region whose root is a point and a region whose root is a road-segment was 
determined in Section A3 above to be a parabola. Since the slope of the plane which is the cost function of the 
road-segment’s region was shown above to be the cost rate of the background, and the slope of the cone is also 
the cost rate of the background, we have the condition which specifies in intersecting a plane with a cone that 
the intersection is a parabola. 

The intersection of two planes is a line, so the boundary between regions which both have linearly- 
traversed edges as roots is a line segment. For example, the hidden-edge merging-path boundary of a high- 
cost, external-goal HCA is such a boundary, and as shown in Section A4a above is indeed a line segment. 

The more complicated boundaries involving one or more Snell's-Law edges ending in a point also 
are consistent with this view, although the mathematics involved in computing the intersections of general- 
ized shapes is complex. Boundaries involving Snell’s-Law edges ending in a hnearly-tra versed edge are of the 
same types as those involving single linearly-traversed edges. Since there are three general types of cost func- 
tions, and each boundary’ can be described as the intersection of two cost functions, there are six non-redun- 
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dant ways that two cost functions may intersect, as in Table 5. Each entry in the last row and the last column 
depends on the number of edges crossed by the region root, and will be different for different numbers of 
edges. For some cases, a boundary listed as a parabola, hyperbola, or distorted parabola or hyperbola will 
degenerate to a straight line. 

A view which takes into account the nature of the cost functions associated with regions which are 
separated by boundaries leads to a more unified approach to the derivation of the analytical forms of the boun- 
daries. This view will become important in the process of merging several single -feature optimal-path maps 
discussed in Chapter VI, since there will be too many possible cases of region intersections to derive each 
analytical form case by case. The above six forms will provide the basis for a general solution to the problem 
of merging OPM ’s. 
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TABLE 5 



BOUNDARY TY PES BY REGION ROOT PAIRS 



Region Root Type (cost function type) 





point 


linear! v-traversed edge 


S-L edge to pt 




(cone) 


(plane) 


(distorted cone) 


point 

(cone) 


hyperbola 


parabola 


distorted 

hyperbola 


linearly-traversed edge 
(plane) 


parabola 


line 


distorted 

parabola 


S-L edge to pt 


distorted 


distorted 


distorted 


(distorted cone) 


hyperbola 


parabola 


hyperbola 
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VI. ALGORITHMS FOR OPM CONSTRUCTION BASED ON SPATIAL 

REASONING 

A. OPTIMAL-PATH TREE CONSTRUCTION 

The first step in constructing an optimal-path map is to build an optimal-path tree (OPT). A straightfor- 
ward way to do this is presented here, although a more efficient way would be to build the OPT during the ex- 
ecution of an algorithm such as recursive-wedge decomposition or the continuous-Dijkstra algorithm. A set 
of optimal paths from the goal point to each terrain-feature vertex is computed using any point-to-point path- 
planning algorithm. The turn points of these optimal paths are then sequentially inserted into the OPT by scan- 
ning each path list from the goal point to its start point as the OPT is traversed from its root (the goal) through 
its internal nodes, matching nodes of the tree with turn points of the path. 

As the insertion algorithm traverses the OPT, a pointer identifies the current node. A pointer also iden- 
tifies the current element of the path list. If the current node has a child node which matches the current ele- 
ment of the path list, the child node becomes the current node and the next element on the path list becomes 
the current one. If the current node has no child node which matches the current path-list element, a new node 
is created which matches the path-list element and whose parent is the current node. Then as before, the child 
node becomes the current node and the next path-list element becomes the current one. When the end of the 
path list is reached, the insertion is complete. When all the terrain-feature-vertex optimal paths have been in- 
serted into the OPT, one final node representing the empty path list (for "start" points with no feasible paths, 
as for example in the middle of an obstacle) is inserted as a child of the root node and the initial OPT is com- 
plete. 

B. BASIC ALGORITHMS FOR ISOLATED TERRAIN FEATURES 

First, we present algorithms to construct planar partitions for four types of isolated single terrain features, 
given optimal-path trees. The planar partition, along with its optimal-path tree, comprises an optimal-path map. 
An algorithm is presented for obstacle, river segment, and road segment primitives, and for each of the four 
cases associated with homogeneous-cost areas (HCA). 
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1. An Algorithm for OPM Construction for A Single Obstacle 

For a single obstacle in a homogeneous-cost background (see Figure 17), the algorithm to construct 
the optimal-path map with respect to a certain goal point, given the optimal-path tree, is straightforward. The 
OPT for a single obstacle will have three branches from the root, one of which will consist only of the empty 
node. Each of the other two branches will coasist of one chain of nodes representing vertices on one side or 
the other of the obstacle. The algorithm begins by taking the obstacle edges as the starting set of homogeneous- 
behavior boundaries. Then it constructs all tlie shadow boundaries by traversing down the two branches of the 
optimal-path tree whose nodes represent vertices on opposite sides of the obstacle, creating a shadow bound- 
ary 7 for each edge of the tree until it finds the leaf node of each branch. Then it constructs the opposite-edge 
boundary starting with the hyperbola generated by the two vertices of the opposite edge and sweeping away 
from the goal. Each time the current segment of the opposite-edge boundary intersects a shadow boundary, a 
new pair of foci is determined, and the new hyperbola segment is constructed. The algorithm is finished when 
the opposite-edge boundary does not intersect any more shadow boundaries. 

Table 6 (on two pages) shows the algorithm for construction of a single obstacle OPM. Algorithms 
are presented using standard procedural conventions as in Chapter III, with natural-language explanations sub- 
stituting for rigorous notation where possible without ambiguity. The input to each algorithm is a representation 
of the terrain feature and an optimal-path tree, representing the optimal paths from each terrain-feature ver- 
tex. The doubly-connected-edge-list (DCEL) data structure presented in Chapter II, Section A is used to rep- 
resent the planar partition. We assume that low-level algorithms are available to manipulate the DCEL, for 
example, insert-into-dcel. Assume also that specifying an optimal-path tree node is equivalent to specifying 
the coordinates of the vertex represented by it, as well as the cost of the optimal path from the vertex to the 
goal. 

The procedure add-obstacle-opposite-edge-bdry is called by the algorithm to construct the opposite- 
edge boundary as it lies outward from the obstacle. It does this by finding, if they exist, points of intersection 
with the shadow boundaries from the two vertices which serve as the foci of the hyperbola which is the active 
portion of the opposite-edge boundary, and choosing the one which occurs closest to the obstacle. Both the 
shadow boundary and the hyperbola are truncated at this point, and new foci and a new hyperbola are deter- 
mined. This hyperbola becomes the active portion of the opposite-edge boundary, and new shadow boundaries 
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TABLE 6 



OBSTACLE OPM ALGORITHM 



algoritlun single-obstacle-opm: 

input: Optimal-Path Tree with root node N 
and associated obstacle edge-list O; 
output: Optimal-Path Map M (a DCEL) 
and modified Optimal-Path Tree N; 
purpose: to construct an OPM for a single obstacle; 
{ 

M := empty dcel structure: 
while (O is not empty ) 

I 

insert-into-dcel(M, First edge of O); 

0 := O less first edge of O; 

} 

Nprev : = N; 

j := 1; 

for each child-node of N 

1 

Ncurr := child-node(N); 
if Ncurr has a child node 
{ 

until Ncurr has no child nodes 

{ 

Nprev := N curi> 

Bdry := Line N CU rrNprev 
less ray NcurrNprev ; 
insert-into-dcel(M.Bdry); 

} 

Opposite-edge-vertexj := Ncurr : 

j :=j + i; 

} 

} 

for j := 1 to 2 

I 

Focusj := Opposite-edge-vertexj; 

Costj := cost of optimal path from 
Opposite-edge-vertexj; 

} 

add-obst-opp-edge-bdry 

(Focus i ,Cost i ,Focus 2 ,Cost 2 ,M,N ); 



(Algorithm VI- 1) 



/* insert obstacle edges into DCEL. */ 

/* initialize N pre v to Goal. */ 

/* construct shadow boundaries. */ 

/* ie, if node is not a leaf node. */ 

/* ie, if node is a region root. */ 

/* traverse to bottom of this branch. */ 

/* ie, ray starling at N CU rr and */ 

/* lying away front N pr ev. */ 

/* add shadow boundary to DCEL. */ 

/* note: there are exactly two such vertices. */ 



f* construct opp-edge bdry. */ 

/* end of single-obstacle-opm Algorithm */ 
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TABLE 6 (CONTINUED) 
OBSTACLE OPM ALGORITHM 



procedure add-obstacle-opposite-edge-boundarv 

input: coordinates and optimal costs from opposite-edge 

vertices, shadow bdrys represented in DCEL M, and optimal-path tree N; 
output: revised DCEL M; 

purpose: to build the opposite-edge bdry by concatenating successive hyperbola segments; 

{ 

ShadBdryi := shadow bdry from Vertex i; 

ShadBdr>’2 := shadow bdry from Vertexz; 

repeat until neither shadow boundary intersects the hyperbola; 

I 

Bdry := segment of hyperbola branch such that /* initialize Bdry to initial leg starting at */ 

Focus i := Vertexi, Focus’ := Vertex2, /* obstacle opposite-edge. */ 

hyperbolic constant := abs(Costi - Cost 2 ), 
and segment lies away from goal: 

Intersect i := point of intersection of Bdry 
with shadow bdry from Focus i; 

Intersect2 := point of intersection of Bdry 
with shadow bdry front F0CUS2: 
if at least one shadow bdry intersects Bdry 
{ 

j := j which minimizes length from the beginning 
of Bdry to Intersectj ; 

Bdry := portion of Bdry between its beginning 
and Intersectj : 

insert-into-dceKM,Bdry); /* add current segment of opp-e. bdry to DCEL. */ 

Bdry := segment of hyperbola branch starting /* get next segment of opposite-edge bdry. */ 
at Intersectj such that Focusj := parent-node(Focusj), 

Costj = Cost of Focusj, hyperbolic constant 
:= abs(Costi - Cost 2 ), and segment lies away from goal; 

ShadBdryj := shadow bdry from Vertexj: /* substitute new shadow bdry from new focus. */ 

I 

else insert-into-dcel(M.Bdry); /* add last segment of opp-edge bdry to DCEL */ 

} 

} /* end of add-obstacle-opp-edge-boundary */ 
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are checked for intersections. When no intersections are found, the procedure is finished and the opposite-edge 
boundary is the concatenation of all the hyperbola segments. 

The algorithm of Mitchell [Ref. 4J also builds an optimal-path map for an obstacle. It allows for mul- 
tiple obstacles, as does Algorithm VI- 1 used in conjunction with Algorithm VI-9 below, and also depends on 
the analytical characterization of homogeneous-behavior boundaries as line segments or sequences of con- 
nected hyperbola segments. His algorithm uses the notion of generalized visibility to build successive sub- 
OPMs. It merges OPMs using Voronoi-diagram construction methods from computational geometry, while 
algorithm VI-9 must use a more ad hoc approach, since Voronoi diagrams for the more general terrain fea- 
tures we consider are not available. 

2. An Algorithm for OPM Construction for A Single River Segment 

The algorithm to construct the planar partition for a single river segment is similarly straightforward 
(see Figure 18). In this case, exactly two shadow boundaries, at most two river-crossing boundaries and one 
opposite-edge boundary need to be constructed. If the river-crossing boundaries intersect, the opposite-edge 
boundary will begin at their point of intersection. Otherwise, no opposite-edge boundary will exist A change 
from the obstacle algorithm is the addition to the optimal-path tree of edges which are crossed by paths, since 
these are homogeneous-behavior region roots. Table 7 shows the river-OPM construction algorithm. 

As discussed in Chapter I, it is possible to model rivers, as well as obstacles and roads, as 
homogeneous-cost areas, and so Algorithms VI-4 and VI-6 could be used instead of Algorithms VI- 1, Vl-2, 
and VI-3. But these first three algorithms are simpler. 

3. An Algorithm for OPM Construction for A Single Road Segment 

The algorithm for a single road segment is somewhat more complicated, although still straightfor- 
ward (see Table 8). As discussed in Chapter V (see Figures 19, 20, and 21), the boundaries which will exist 
for a road segment are determined by the positioning of the characteristic wedge with respect to the road ver- 
tices. Therefore, top-level decision logic for the algorithm is based on the position of the characteristic wedge. 
Procedure construct -rd-bdry is called to compute each specific boundary. 

4. An Algorithm for A Single Convex High-Cost Exterior-Goal Homogeneous-Cost Area 

The algorithm to compute the planar partition for high-cost area with an external goal is called hca- 
opm-high-ext (see Table 9). The equations for each boundary can be found in Appendix A in the Lemma cor- 



111 



TABLE 7 



RIVER-SEGMENT OPM ALGORITHM 



algorithm single-river -segment-opm (Algorithm VI-2) 

input: Optimal-Path Tree with root node N and associated river edge-list R with cost C r ; 
output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct an OPM for a single isolated river segment; 

{ 

M := empty dcel structure; 

for Ncurr := each river- vertex child-node of N /* construct shadow boundaries */ 

( 

Bdry := Line N CU rrN less Half-line N CU rrN; /* ie, half-line starting at N CU rr, away from goal */ 

insert -into-dcel(M3dry); /* add shadow boundary to DCEL. */ 

) 

for j := 1 to 2 

I 

Focusj := River-Vertexj; 

Costj := cost of optimal path from River- Vertexj; 

Bdryj := segment of hyperbola branch with foci /* river-crossing bdry for each river vertex. */ 

Focusj and Goal, hyp constant = abs(Costj - C r ), 
such that branch is closer to Focusj; 
if Bdryj intersects river segment 
Intersectj := intersection point; 
else 

Bdryj := null list; 

) 

if Bdry i is not null 

{ 

lntersect|,2 := intersection of Bdryi and Bdry2 ; 

Bdry i := Bdryi from Intersecti to Intersect^ ; 

Bdry2 := Bdiy2 from Intersect2 to Intersecti, 2 ; 
insert-into-dcel(M,Bdry 1 ); 
insert-into-dcel(M3dry2); 

Bdry := segment of hyperbola branch with 
Focus 1 and Focus2, hyperbolic constant = 
abs(Costi - Cost2), such that branch is closer 
to the higher-cost focus, with starting point at 
Intersect 1,2, lying away from goal; 

River-edge 1, 2 := Line from Intersecti to Intersect2 ; 

insert-into-opt(N3iver-edgei,2); /* add river-crossing edge to Optimal-Path Tree. */ 

) 

else 

Bdry := segment of hyperbola branch with /* find opp-edge bdry if no river-crossing bdrys. */ 

Focus 1 and Focus2, hyperbolic constant = 
abs(Costi - Cost2), such that branch is closer 
to the higher-cost focus, with starting point at 
intersection of hyp and river, lying away from goal; 
insert-into-dcel(M,Line from Focus 1 to F0CUS2); I* add river edge as bdry */ 
insert-into-dcel(M3dry); /* add opposite-edge bdry to DCEL */ 

) /* end of single-river-opm Algorithm */ 



/* if so, find intersection point */ 

/* if not, river-crossing bdry does not exist. */ 
I* (neither bdry or both bdrys will be null) */ 

I* add river-crossing bdry 1 to DCEL. */ 

/* add river-crossing bdry 2 to DCEL. */ 

/* find opposite-edge bdry. */ 
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TABLE 8 



ROAD-SEGMENT OPM ALGORITHM 



algorithm single-road-segment-opm (Algorithm VI- 3 ) 

input: Optimal-Path Tree with root node N and associated road edge-list R with cost C r ; 
output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct an OPM for a single, isolated road segment; 

I 

M := empty dcel structure; 

0C := sin (Cr/Cbackgrouml); 

Wedge-Ray i := ray from G intersecting road V1V2 
at Pt A such that /. GAV2 =IC /2 — 0 C ; 

Wedge-Ray2 := ray from G intersecting road V1V2 
at Pt B such that ZGBV 1 = k /2 — 0 C ; 
if pts A, B, and V 1 are ordered "B AV 1" 

{ 

construct-rd-bdry(road-end/travelling,Vi); 
construct-rd-bdry(road-end/goal,Vi); 
construct-rd-bdry(near-side-road-lravelling/goal,Vi); 

if pts A 3 , & V2 are not ordered "V2AB" /* if in addition wedge is not "outside" V2, */ 

construct-rd-bdry(road-tra veiling/crossing, V 1); /* generate type e bdry on V 1 end. */ 

) 

else if they are ordered "BV iA" /* wedge "straddles” Vi so generate boundary */ 

construct-rd-bdry(road-shadow,Vi); /* type g on the Vi end */ 

else if they are ordered "V iBA" /* wedge is "outside" Vi so generate boundary */ 

I 

construct-rd-bdry(near-side-rd-traveirg/goal,V2); /* types d on the V2 end and f on the Vi end */ 
construct-rd-bdry(far-side-road-trdvelling/goal,V2); 

} 

if pts A, B, and V2 are ordered "ABV2" /* wedge is "inside" V2 so generate boundary */ 

{ 

construct-rd-bdry(road-end/traveUing,V2); /* types b,c and d on the V2 end. */ 
construct-rd-bdry(road-end/goal , V2); 
construct-rd-bdry(near-side-road-travelling/goal,V2); 

if pts A 3 , & V 1 are not ordered "V iB A" /* if in addition wedge is not "outside" V 1 , */ 

construct-rd-bdry(road-travelling/crossing,V2); /* generate type e bdry on V2 end. */ 

) 

else if they are ordered "AV2B" /* wedge "straddles" V2 so generate boundary */ 

construct-rd-bdry(road-shadow,V 2 ); /* type g on the V2 end. */ 

else if they are ordered "V2AB" /* wedge is "outside" V2 so generate boundary */ 

{ 

construct-rd-bdry(near-side-rd-travell’g/goal, v 2); /* types d on the Vi end and f on the V2 end. */ 
construct-rd-bdry(far-side-road-travelling/goal,Vi); 

} 

} /* end of single-road-opm algorithm */ 



/* road critical angle */ 

/* A is oriented to B as Vi is to V2 (see Chap V)*/ 
/* wedge is "inside" Vi so generate boundary */ 

/* types b,c and d on the Vi end. */ 
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TABLE 8 (CONTINUED) 
ROAD-SEGMENT OPM ALGORITHM 



procedure construct-rd-bdry 

; input: type of bdry T, vertex V of road, DCEL M, Optimal-Path-Tree N, and Wedge-Ray i and Wedge-Ray2 
output: revised DCEL M and revised OPT N; 
purpose: construct each road- generated boundary of type T; 

{j := 3-i; /* if i=l, j=2 and if i=2, j=l, i.e., j is other end */ 

if T = road-end/travelling /* Type "b" boundary */ 

(Bdryi := Ray with vertex Vi, lying on line ViX, such that Z.VjV \K = rt/2+0 c ; 

Bdry2 := Ray with vertex Vi, lying on line VjY, such that ZVjVjY = 3rt/2— 0 C ; 
insert-into-dcel(M3dry i ); /* add road-end/travelling boundary to DCEL. */ 

insert-into-dcel(M,Bdry 2 ); /* add road-end/travelling boundary to DCEL. */ 

} 



else if T = road-end/goal /* Type "c" boundary */ 

{Bdry := the branch closer to Vi of a hyperbola with foci Vi and Goal, and hyp. constant = cost from 
Vi to Goal via road, starting at point of intersection between hyperbola and type b bdry from Vi; 
insert-into-dcel(M3dry); /* add road-end/goal boundary to DCEL. */ 

} 

else if T = near-side-road-travelling/goal /* Type "d" boundary */ 

{ if (wedge is not outside Vj) /* wedge is inside Vi & not outside Vj */ 

Bdry := segment of parab. s.t. focus = Goal, and directrix DXWedge-Rayj with D being IGPI from P 
(P=A if i=l, else P=B), starts at P, lies away from Goal, ends at inters, with type b bdry from Vi; 
else /* wedge is inside Vj & outside Vj */ 

Bdry := segment of parabola with focus = Goal and directrix = line L, LJLWedge-Rayj such that L is 
IGVjl from Vj, starting at P := Vj, lying away from Goal, ending at inters, with type b bdry from Vi; 
insert-into-dcel(M3dry); /* add near-side-road-trvlg/goal bdry to DCEL. */ 

insert-into-opt (N,PVjJNear-side); /* add travelled road segment to OPT. */ 

insert-into-dceI(M3Vi); /* add travelled segment as edge bdry to DCEL */ 

} 

else if T = road-travelling/crossing /* Type "e" boundary */ 

(Bdry := ray starting at P and lying along Wedge-Rayi, 

(where P=A if i=l and P=B if i=2), lying away from Goal; 



insert-into-dceI(M,Bdry); 
insert-into-opt (N.edge PVj3ar-side); 
insert-into-dceI(M3Vi); 

} 



/* add road-travelling/crossing bdry to DCEL.*/ 
/* add road segment which is travelled to OPT. */ 
/* add travelled segment as edge bdry to DCEL */ 



/* Type "f boundary */ 

/* road-edge boundary added to DCEL */ 



else if T = far-side-road-lra veiling/goal 
(insert-into-opt (N,VjVj,Near-side); 
insert-into-opt (N,VjVjFar-side); 
insert-into-dcel (MJLine ViVj); 
fork := 1 to 2 

(Bdryk := segment of parabola with focus = Goal, and directrix = line L, LX Wedge - 
Rayk such that L is IGVjl from Vi, starting at Vj and lying away from Goal; 
insert-into-dceKM,Bdryk); /* add far-side-road-trvlg/goal bdrys to DCEL. */ 

} 

} 

else if T = road-shadow /* Type "g" boundary */ 

{ Bdry := ray from Vi along line ViG, lying away from Goal; 

insert-into-dceKM3dry); /* add road-shadow bdry to DCEL. */ 

} 

} /* end of construct-rd-bdry */ 
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TABLE 9 



HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 

algorithm hca-opm-high-ext (algorithm VI-4) 

input: Optimal-Path Tree N, HCA A with n vertices; 
output: DCEL M, and modified OPT N; 

purpose: to construct the OPM for a high-cost, exterior-goal HCA. 

{ 

for i := 1 to n /* add interior bdry for each vertex. */ 

[ 

if edge i is visible 
if edge i+1 is visible 

B := value returned by const ruct-high-ext-hca-bdry("visible-edge",i); 
else 

B := value returned by construct-high-ext-hca-bdry("visible-hidden",i); 
else if edge i is hidden 
if edge i+1 is visible 

B := value returned by construct-high-ext-hca-bdry("visible-hidden",i+l); 
else 

if edges are on different sides of opposite edge 

B := value returned by construct-high-ext-hca-bdry("hidden/diverging”,i); 
else 

B := value returned by construct-high-ext-hca-bdry("hidden/merging",i); 
add B to BdrySet; 

) 

BdrySet := value returned by pair-and-merge-bdrys /* join interior bdrys together. */ 

(Bdry Set, "high-ext-hca-interior"); 
form BdryTrees from bdrys in BdrySet; 
for each BdryTree 
( 

find point X at which BdryTree /* there will be exactly one X per tree */ 

intersects an opposite edge; 

B := value returned by construct-high-ext-hca-bdry("opposite-edge",X); 
add B to OEBdrySet; 

} 

for i := 1 to n 

if Vi connects a visible and a hidden edge 

{ 

if Vi is not connected to any interior BdryTree 

add construct-high-ext-hca-bdry("comer-cutting",X) to BdrySet; 

B := value returned by construct-high-ext-hca-bdry("shadow",i); 
j := other vertex of Ei 

while Ej is not an opposite edge /* work around the HCA creating shadow */ 

{ /* bdrys until the opposite edge is found. */ 

B := value returned by construct-high-ext-hca-bdry("shadow",j); 
j := other vertex of Ei 
} 

} 

B := value returned by pair-and-merge-bdrys /* join opposite-edge bdrys together. */ 

(OEBdrySet, "hi gh-ext-hca-exterior"); 
add B to BdrySet; 
for all B € BdrySet 
insert-into-dceI(M3); 

} /* end of hca-opm-high-ext */ 
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TABLE 9 (CONTINUED) 

HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



procedure pair-and-merge-bdrys /* join connecting bdrys together. */ 

input: BdrySet, and type of region; 
output: revised BdrySet; 

purpose: to take an initial set of boundaries, pair the ones which first intersect each other, and 

propagate a new bdry from each intersected pair, continuing until all appropriate bdrys are joined. 

( 

while BdrySet is changing 

( 

PairedBdrySet := BdrySet; 
while PairedBdrySet is changing 
( 

for all Bj.jG PairedBdrySet where Bi.j is unmarked 

( 

discard Bj,j from PairedBdrySet; 
add Bi,j from BdrySet to PairedBdrySet; 
intersect Bj ; with Bh.i and truncate both; 
add Bh,i tn,n<? and Bij 1 ™" 0 to PairedBdrySet; 
intersect Bi,j with Bj.k andtmncate both; 
add Bi,/™" 0 and Bj.k c := to PairedBdrySet; 

I 

for all Bi,jG PairedBdrySet 

discard all but the shortest Bj.j from PairedBdrySet; 
unmark all bdrys in PairedBdrySet; 

for all Bj.j and Bj.kG PairedBdrySet such that Bi.j adjoins Bj,k 
mark Bi,j and Bj,k; 

I 

for all Bjjand Bj,kG PairedBdrySet such that Bi.j adjoins Bj,k 
add Bi,k to PairedBdrySet; 

BdrySet := PairedBdrySet; 

I 



I 



/* end of pair-and-merge-bdrys. */ 



TABLE 9 (CONTINUED) 

HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



procedure construct-high-ext-hca-bdry 
input: type of bdry T; index of vertex i; 



/* provides methods to construct each type of */ 
/* bdry of high-cost, exterior-goal HCA. */ 



output: Bdry, the resulting boundary; 

purpose: to construct a boundary generated by vertex i of type T; 

{ 

ifT = "visible-edge" 

Bdry := curve as specified in Lemma V-4.1; 
ifT = "visible-hidden" 

Bdry := curve as specified in Lemma V-4.2; 
if T = "merging" 

Bdry := curve as specified in Lemma V-4.3; 
if T = "diverging" 

Bdry := curve as specified in Lemma V-4.4; 
if T = "hca-edge" 

Bdry := curve as specified in Lemma V-4.7; 
if T = "shadow" 

Bdry := curve as specified in Lemma V-4.8; 
if T = "opposite-edge" 

Bdry := curve as specified in Lemma V-4.9; 
if T = "comer-cutting" 

Bdry := curve as specified in Lemma V-4. 10; 

} /* end of construct-high-ext-hca-bdry */ 
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responding to the boundary type (see also Figures 23, 24, and 25). Each vertex of such a HCA is associated 
with an internal boundary, whose character depends on whether the edges incident to the vertex are visible or 
hidden (and for vertices on two hidden edges, on whether the vertices nearest the goal for each edge have op- 
timal paths which go in the same, or different directions around the HCA, called merging or diverging paths 
respectively). These boundaries are computed first, and then procedure pair-and-merge-bdrys constructs a 
network (or networks) of interior boundaries which is connected to the initially-computed boundaries. This 
procedure pairs boundaries which intersect, and then plots a new boundary which has an endpoint at the point 
of intersection of the paired boundaries. It continues pairing boundaries and plotting new ones until all the 
boundaries are joined together on both ends or intersect an edge of the HCA. Note that deciding which ad- 
jacent boundaries should be paired together is not simple, and it may take several iterations for the procedure 
to settle on a correct configuration. 

The interior boundaries are then joined into trees, and since each interior boundary tree intersects an 
opposite edge exacdy once, this can serve to begin generation of the external opposite-edge boundaries. In 
contrast to obstacles, there can be several HCA opposite edges and opposite-edge boundaries. Comer-cutting 
boundaries are indicated when an interior boundary associated with a vertex actually begins, not at the vertex, 
but somewhere along the boundary. The algorithm next checks for this situation, which can only happen with 
respect to a vertex joining a hidden and a visible edge. This type of vertex is also a good place to begin generat- 
ing shadow boundaries. Finally, procedure pair-and-merge-bdrys is again used, this time with the exterior 
shadow and opposite-edge boundaries. 

Figures 30, 3 1, and 32 illustrate the state of procedure pair-and-merge-bdrys at various intermediate 
stages in its execution for the example HCAs of Figures 23, 24, and 25 respectively. Edges of the HCAs are 
numbered, and boundaries are labeled "i,j", where i and j represent the edges crossed by paths on either side 
of the boundary. Boundaries which are paired with another boundary at each stage are noted by an asterisk. 
Boundaries which are stored in the data structure PairedBdrySet are noted in the figures as dark lines. Figure 
30a, 31a, and 32a show the interior boundaries associated with each terrain- feature vertex at the beginning of 
the algorithm (beginning at the vertex or associated short-cutting point, extending indefinitely into the inte- 
rior and then beyond. The current set of interior-boundary trees is also shown, with each node labeled by the 
boundary it represents. 
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Figure 30 

Construction of HCA Interior-Boundary Tree Example 1 
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Figure 31a 

Construction of HCA Interior-Boundary Tree Example 2 
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Figure 31b 

Construction of HCA Interior-Boundary Tree Example 2 
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Consider, for example, Figure 31. Figure 31b shows the state of PairedBdrySet with respect to the 
HCA after the first pass through the inner loop ("while PairedBdrySet is changing"), where each boundary 
"i,j" in the initial set of boundaries is intersected with the two adjacent boundaries, and the shortest version of 
"i,j" is retained in PairedBdrySet. Those boundaries which pair up with an adjacent boundary are marked with 
In Figure 3 lb, " 1 ,6" pairs with "5,6" and " 1 ,2" pairs with "2,3". "4,5" and "3,4" were not marked, and so 
are going to be replaced in PairedBdrySet by the full versions of their respective boundaries at the start of the 
next pass through the inner loop. After the second pass through the inner loop, all boundaries are marked as 
in Figure 3 lc, so on the next iteration no changes to PairedBdrySet will be made, so the "while changing" con- 
dition will fail, ending the inner loop. 

As the outer loop ("while BdrySet is changing") finishes its first pass, new boundaries are generated 
from each intersection point of paired boundaries, and these boundaries arc placed, unmarked, into Paired- 
BdrySet, which replaces BdrySet. This situation is reflected in Figure 3 Id. Figure 3 le reflects the state of 
PairedBdrySet after the outer loop has started its second pass, and the inner loop has run until it stabilizes 
again. Note that some boundaries which were paired after pass one, i.e., "4,5" and "3,4", are in fact intersected 
by second-level boundaries instead, and so the truncated versions of the boundaries need to be retracted from 
PairedBdrySet and the full versions put back into PairedBdrySet for further interaction with second-level boun- 
daries. This illustrates why such this procedure is complicated, because we are not able to tell with a single 
pass which boundaries will be paired. Boundary "1,4" is now propagated from both directions from the inter- 
section points of "4,5" and "1,5" as well as "1,3" and "3,4". It is truncated at both ends and paired with itself, 
after which the configuration is stable. Thus BdrySet will not change further, so the outer loop will halt with 
BdrySet as illustrated in Figure 3 1 f. At each stage, the interior-boundary trees are built up until, in Figure 3 1 f, 
a single tree results. 

In algorithm hca-opm-high-ext, it is assumed initially that there is an opposite point, i.e., a point on 
the hidden side of the HCA where two optimal paths go in opposite directions around the HCA. Further, this 
assumed opposite point is initially considered a vertex for the purposes of the algorithm. Figure 30 shows a 
situation where the algorithm leads to the conclusion that the opposite point does not exist after all, and so 
there is no interior boundary incident to it, because there is shortcutting of paths from the outside of the HCA 
across the HCA to the goal. The figure also shows a situation where there is more than one interior-boundary 
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tree. There is one exterior opposite-edge boundary incident upon an HCA edge associated with each interior- 
boundary tree. It has one endpoint at the point at wliich a boundary of the tree intersects an opposite edge. 

5. An Algorithm for OPM Construction for A Single Convex High-Cost, Interior-Goal 
Homogeneous-Cost Area 

A much different algorithm is needed to construct boundaries for the case of a high-cost HCA with 
an interior goal point (see Figure 26). The existence of interior boundaries are more predictable without the 
need for the iterative checking as in the high-cost, exterior-goal HCA case. It is still necessary, however, to 
check the intersections of various boundaries and truncate them appropriately, and insert portions of edges 
into the optimal-path tree, which is done at the algorithm’s conclusioa (See Table 10.) 

The algorithm proceeds by looking at each HCA vertex in turn, and determining by observing its op- 
timal path whether it is a hidden or a visible vertex. If it is a hidden vertex, the path from the vertex will travel 
along an edge of the HCA before cutting into the interior, while if it is a visible vertex, the path will go direct- 
ly to the goal. If it is hidden, several interior boundaries and one exterior shadow boundary are generated, as 
well as possibly an opposite-edge boundary. If it is visible, only one exterior boundary, a visible-edge bound- 
ary, is generated. 

It is necessary to insert portions of edges into the optimal-path tree according to the traversal charac- 
teristics of optimal paths across or along them. For example, it is possible for a portion of an edge from one 
vertex to act like a road, where paths leave the HCA interior to travel along the lower-cost edge, and then cut 
back in to the HCA when nearer to the goal. Thus the first portion of the edge would be the root of a 
homogeneous-behavior region characterized by paths crossing from the interior to the exterior and travelling 
along the edge, and the next portion of the edge would be the root of another region characterized by paths 
crossing from exterior to interior. All this information is not available when processing each individual ver- 
tex, however, so edges which may become region roots are stored temporarily, and at each step when infor- 
mation is gained which could rule out portions of edges as roots, that information is stored as a "mask", which 
is used to mask out portions of edges. At the conclusion of the algorithm, these edges and masks are processed 
to determine exactly which portions of edges belong as region roots in the optimal-path tree. Also done at the 
conclusion of the algorithm is the intersecting of opposite-edge and shadow boundaries and plotting of new 
boundaries in the HCA exterior, much like in the interior of a high-cost, exterior-goal HCA. 
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TABLE 10 



HIGH-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



algorithm hca-opm-high-int (algorithm VI- 5 ) 

input: Optimal-Path Tree with root N, HCA A with u vertices; 
output: DCEL M and revised OPT N; 
purpose: construct an OPM for high-cost, interior-goal HCA; 

{fori := 1 to n 

{ if P & Goal, where OPL(Vj) = [P I OPL(P)] /* i.e., if path from V lies on edge E2 of HCA */ 

{ /* with other edge called Ei, an interior linear */ 

E2 := edge containing ViP; /* bdry and two parabolic bdrys are formed, */ 

Ei := other edge incident to Vi; /* and an exterior shadow boundary is formed. *f 

B| := value returned by construct-high-int-hca-bdry("hidden-edge",Vi); 

B2 := value returned by construct-high-int-hca-bdry("hidden-edge/goal",Vi); 

B3 := value returned by construct-high-int-hca-bdrjC’visible-edge/goaT.P); 

B4 := value returned by construct-high-int-hca-bdry("shadow",P); 
add B4 to ExtBdrySet; 

intersect B 1, B2, B3 & add B i ,nInc to IntBdrySet; /* they intersect at the same point. */ 
if B2 intersects Ei at some pt X 
{ truncate B2 at X; 
add B 2 ' n,nc to IntBdrySet; 
insert-into-opt(N,ViX, "Near-side"); 
add Ei and Mask(ViX) to VisEdgeSet; 

B5 := value returned by constimct-high-int-hca-bdry("corner-cutting ,, ,X); 
add B5 to ExtBdrySet; 

} /* if paths from two vertices go opposite ways */ 

else if (OPL(Vi) <2 OPL(V i+ i) and OPL(V i+ i) <2 DPL(Vi» /* around HCA, edge is opp edge. */ 
{B 6 := value returned by construct-high-int-hca-bdry("interior-opposite-edge",Vi,V i+i); 
intersect B 6 with B2 & add Be *™ 00 to IntBdrySet; 

X := pt where B 6 intersects Ei; 

B7 := value returned by construct-high*int-hca-bdry("exterior-opposite-edge",Vi,Vi+i); 
add B7 to ExtBdrySet; 
insert-into-opt(N,ViX, "Near-side"); 
insert-into-opt(N,XVi + 1 , "Near-side"); 

} 

else 

(insert-into-opt(N,Ei, "Near-side"); 
add B 2 ' n,nc to IntBdrySet; 

} 

if B3 intersects edge E2 at X 

{ insert-into-opt(N,ViX, "Near-side"); 

truncate B3 at X; 

add B 3 tn,nc to IntBdrySet; 

} 

} 

else /* i.e., if path goes from V directly to Goal. */ 

{B := value returned by construct-high-int-hca-bdry("visible-edge",V|); 
add B to ExtBdrySet; 
add Ei and E2 to VisBdrySet; 

} 

post-process-high-int-hca-bdrys; 

} 



/* end of hca-opm-high-int */ 



TABLE 10 (CONTINUED) 

HIGH-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



procedure construct-high-int-hca-bdry /* constructs each type of bdry formed by*/ 

input: type of bdry T; P, the start-point of bdry; /* a high-cost, interior-goal HCA. */ 

output: Bdry, the resulting boundary; 

purpose: to construct a boundary generated from point P of type T; 

{if T = "hidden-edge" Bdry := curve as specified in Lemma V-5.1; 
if T = "hidden-edge/goal" Bdry := curve as specified in Lemma V-5.2; 
if T = "visible-edge/goal" Bdry := curve as specified in Lemma V-5.3; 
if T = "interior-opposite-edge" Bdry := curve as specified in Lemma V-5.4; 
if T = "hca-edge" Bdry := curve as specified in Lemma V-5.5; 
if T = "shadow" Bdry := curve as specified in Lemma V-5.6; 
if T = "exterior-opposite-edge" Bdry := curve as specified in Lemma V-5.7; 
if T = "comer-cutting" Bdry := curve as specified in Lemma V-5.8; 
if T = "visible-edge" Bdry := curve as specified in Lemma V-5.9; 

} /* end of construct-high-int-hca-bdry */ 



procedure post-process-high-int-hca-bdrys /* store bdrys and edges. */ 

input: VisEdgeSet, the set of bdrys from visible edges, IntBdrySet, the set of 
interior bdrys, ExtBdrySet, the set of exterior bdrys, and Optimal-Path Tree N; 
output: DCEL M, and revised OPT N; 

{ for each edge E € VisEdgeSet 
{ for all Maske E := E less MaskR 
N := value returned by insert-into-opt(N,E); 

} 

for each bdry B € IntBdrySet 
if another version of B exists 
{truncate B andB'; 
insert-into-dcel(M3tnmc); 

} 

for each bdry B e ExtBdrySet 
join-high-int-bdrys(B, ExtBdrySet); 
for each bdry B € ExtBdrySet 
insert-into-dcel(M3); 

) /* end of post-process-high-int-hca-bdrys */ 



procedure join-high-int -bdrys /* joins external bdrys. */ 

input: bdry B 1 , set of bdrys ExtBdrySet; 
output: revised ExtBdrySet; 

purpose: to pair bdrys which first intersect, and propagate new ones from their pt of intersection. 
{ for each B 2 € ExtBdrySet such that B 1 and B 2 intersect and B1 and B2 are adjacent 
{truncate B 1 and B 2 ; 

remove original B 1 and B 2 from ExtBdrySet; 



add B i‘ n,nc and B 2 '™ nc to ExtBdrySet; 

T := type of new bdry; 

B 3 ;= value returned by 
construct-hca-opm-high-int-bdry(T,Ei 32 ) 
join-high-int-bdrys(B33xtBdrySet); 

} 



/* based on edges El and E2 not */ 
/* common to B i ,runc and B 2 tninc 



/* recursively follow bdry outward from HCA. */ 
/* end of join-high-int -bdrys. */ 



} 
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6. An Algorithm for OPM Construction for A Single Low-Cost, Exterior-Goal 
Homogeneous-Cost Area 

The exterior- goal-low-cost-region algorithm shown in Table 1 1 looks at each HCA vertex in turn, 
basing its logic on the initial direction of the optimal path from the vertex being examined (see Figure 27). If 
the optimal path from a vertex goes into the HCA interior, two rays, or vertex/edge-crossing boundaries, are 
constructed forming a wedge outward from the vertex and away from the goal. If the optimal path goes along 
an edge of the HCA, one of the above boundaries, the one closer to the direction of travel of the optimal path, 
is instead a vertex/edge-following boundary, and in addition a parabolic, or vertex/goal boundary is con- 
structed. The third possibility is that the optimal path goes directly into the HCA exterior, i.e., toward the goal. 
If so, more boundaries may or may not be generated. If a portion of each edge adjacent to the vertex is visible 
to the goal, i.e., if for both edges there are paths starting at some points on the edges which go directly into the 
HCA exterior, then a visible-edge boundary will emanate from the vertex into the HCA interior. 

With the above boundaries generated, two tasks remain. First, each parabolic, oredge-following/goal 
boundary must be followed away from the goal to see if it intersects the next ray boundary. If so, a hyperbolic, 
or vertex/goal boundary will begin, with one focus at the vertex. This hyperbola must then be followed in turn. 
If it intersects a ray boundary, a "distorted-parabolic", or edge-crossing/goal boundary will begin. As we con- 
tinue to follow this sequence of boundaries, hyperbolas and distorted-parabolas occur alternately until no in- 
tersection with a ray is found. Note that this algorithm generates each parabolic and distorted-parabolic 
boundary in the initial phase, and then generates hyperbolas as needed in procedure add-hyp-bdrys-for-Iow- 
ext-hca below, which in addition truncates each boundary as necessary. 

Although this type of HCA has interior boundaries, which one might suppose would need to be paired 
and merged as with the high-cost, exterior-goal case, in fact it is not necessary to do this. The reason is that 
such boundaries are all of the visible-edge type, and because the HCA interior is of lower cost than the sur- 
rounding terrain, these boundaries will never intersect. Intuitively in the high-cost exterior-goal case, a path 
travels to an edge further away in straight-line distance in order to take advantage of the lower external cost 
outside that edge, and at that point, two boundaries would intersect and a third emerge. Here, however, the 
path is already in the least costly terrain possible, and so further paths will continue to follow the same paths 
as those closer to the goal. For each visible-edge boundary, a point of intersection is plotted with the far edge 
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TABLE 11 



LOW-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



algorithm hca-opm-low-ext (algorithm VI- 6 ) 

input: Optimal-Path Tree with root N, and HCA A; 

output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: construct an OPM for a low-cost, exterior-goal HCA; 



{ 

for each vertex V of A with incident edges Ei and E2 
such that Ei = W 1 and E2 = VV2, where IV2GI > 
IViGI and OPL(V) = [P I OPL(P)] 

{ 

if VP lies in HCA interior 

{ 

construct-Iow-ext-hca-bdry( vertex/ 
edge-crossing, V,V i,V 2 ); 
construct-Iow-ext-hca-bdry( vertex/ 
edge-crossing, V,V2,V 1); 
insert-into-opt(N,VV 1 JFar-side); 
insert-into-opt(N,W2, Far-side); 

) 

else if VP lies along HCA edge Ei 

{ 

construct-low-ext-hca-bdry(edge-following/ 

goaI,V,Vi,V 2 ); 

construct-low-ext-hca-bdry( vertex/ 
edge-following, V,Vi ,V2); 
construct-Iow-ext-hca-bdry( vertex/ 
edge-crossing, V,V2,Vi); 
insert-into-opt(N,VP,Near-side); 
insert-into-opt(N,W2 Far-side); 

} 

else if ((Q 1 is in HCA exterior) or (V|Q 1 e V 1 V)) 
and ((Q2 is in HCA exterior) or (V2Q2€ V2V))) 
where OPL(Vi) = [Qi I OPL(Qi)] 
and OPL(V 2 ) = [Q2 1 OPL(Q 2 )J 
{ 

construct-low-ext-hca-bdry(visible-edge, 

v,vi,v 2 ); 

for i := 1 to 2 
if(ViQie ViV) 

insert-into-opt(N, QiV, Far-side); 
else insert-into-opt(N, VjV, Far-side); 

} 

} 

add-hyp-bdrys-for-Iow-ext-hca(ParabBdrys); 

} 



/* consider each vertex and its adjacent edges */ 

/* where Vi is closer to goal than V2, and */ 

/* where P is the first point on V’s opt path. */ 

/* if optimal path from V goes into HCA interior */ 



/* two rays are Snell’s-Law patlis across */ 
/* edges Ei and E2 through vertex V */ 

/* add edges to OPT as region roots. */ 



/* if opt. path from V goes along an HCA edge */ 



/* two rays are Snell’s-Law paths across */ 
/* edges Ei and E2 through vertex V */ 

/* add edges to OPT as region roots. */ 



/* if both edges are visible or partially visible */ 
/* (optimal path from V lies in HCA exterior). */ 
/* Note: Qi are the first points on */ 

/* the optimal-path lists of each Vi */ 

/* vis-edge bdry from V w.r.t. Ei and E2 */ 



/* add as region root the portion of */ 
/* edge across which paths cross. */ 



/* end of algorithm hca-opm-low-ext */ 
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TABLE 11 (CONTINUED) 

LOW-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



procedure add-hyp-bdrys-for-low-ext-hca; /* puts hyperbolas between pairs of ray bdrys */ 

input: ParabBdrys, the set of parabolic boundaries; 
output: revised DCEL; 

purpose: to concatenate hyperbolic bdrys onto parabolic ones. 

I 

while ParabBdrys ^ 0 
{ 

select bdry B iG ParabBdrys associated with vertex Vi and edge Ej ; 
truncate Bi and the vertex/edge-following or vertex/edge-crossing bdry B2 emanating 
from Vi, and associated with edge Ej at the point where they intersect; 

B4 := value returned by construct -low- /* bdry is hyperbola intersecting one or */ 

ext-hca-bdry(vertex/goal,Vi,Vj,Vk); /* both rays emanating from vertex Vi */ 

if B4 intersects vertex/edge-crossing bdry 
B3 associated with Vj and edge Ek, k^j, 

( 

truncate B3 and B4 at their point of intersection; 

truncate B5G ParabBdrys assoc, with V g and Ek, g^i, at its intersection with B3 and B4 ; 

J 

remove B 1 from ParabBdrys; 

} /* end add-hyp-bdrys-for-low-ext-hca */ 



of the HCA, and an opposite-edge boundary is generated, which is really just a continuation of the visible- 
edge boundary after crossing another edge. 

Procedure construct-low-ext-hca-bdry performs the low-level function of generating each bound- 
ary for the low-cost, exterior-goal HCA as needed. For boundaries whose forms are general curves, the reader 
is referred to the appropriate Lemma in Chapter V and proof in Appendix A. 

7. An Algorithm for OPM Construction for A Single Low-Cost, Interior-Goal 
Homogeneous-Cost Area 

Algorithm hca-opm-low-int is the simplest of the four HCA algorithms, in keeping with the simple 
nature of the regions and boundaries associated with this type of HCA (see Figure 28 and Table 12 ). Since a 
low-cost, interior-goal HCA generates only one wedge of two rays at each vertex, and these rays are guaran- 
teed by the orientation of the HCA edges not to interact, the corresponding algorithm can do its work in one 
pass through the list of vertices. 
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TABLE 12 



LOW-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 



algorithm hca-opm-low-int (algorithm VI-7) 

input: Optimal-Path Tree with root N, and HCA A; 

output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct the OPM for a low-cost,, interior- goal HCA; 



{ 

M := empty dcel structure; 
for each edge V 1 V 2 of A 

I 

Bdryi := ray starling at Vi, lying away 
from Goal G thru pt Xi, such that 
ZGViV 2 = tc/2-01, ZX 1 V 1 V 2 = 71/2+02 , 
and cint sinOi = Cext sin 02; 

Bdry2 := ray starting at V 2 , lying away 
from Goal G thru pt X 2 , such that 
ZGV 2 V 1 = 71/2—01, ZX 2 V 2 V 1 = 71/2+02 , 
and cint sin0i = Cext sin 02 ; 
insert-into-dcel(M, Bdryi); 
insert-into-dcel(M,Bdry 2 ); 
insert-into-dcel(M,V 1 V 2 ); 
insert-into-opt(N,edge V 1 V 2 , Far-side); 

) 

} 



/* two bdrys emanate from each vertex, */ 
/* at the Snell’s-Law angle with respect */ 
/* to each edge. */ 



/* add vertex/edge-crossing bdrys to DCEL.*/ 

/* add HCA-edge boundary to DCEL */ 

/* add edge which is crossed to OPT. */ 

/* end of hca-opm-low-int */ 



C. EXTENDING THE BASIC ALGORITHMS TO MULTIPLE CONNECTED RIVER AND 
ROAD SEGMENTS 

1. An Algorithm for OPM Construction for Multiple Connected River Segments 

It is now possible to build on a basic understanding of the nature of boundaries generated by single, 
isolated river segments in order to construct the boundaries associated with multiple, connected linear river 
segments, or rivers. There may be two or more river segments emanating from a single vertex, but all seg- 
ments of a river must have the same crossing cost. It might be thought that the algorithm proposed below to 
construct the optimal-path map for multiple terrain features could be used to construct it for this kind of ter- 
rain as well. However, connected river segments are not "decomposable" into their constituent segments. 
Decomposability of a set of terrain features is defined as follows. 
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Terrain map M with optimal-path tree N is defined as decomposable for path planning into subsets 
Si and S 2 if both S 1 and S 2 are consistent with OPT N. Say that a set of terrain Si which is a subset 
of a set of terrain S is consistent with an OPT N constructed for S if for an OPT Ni constructed for 
Si considered alone, every node of Ni appears in N, and the parent of every node of Ni appears in 
the path from the node to the root of N. 

In other words, if one subset could not behave in the way it does without the presence of the other, 
the terrain is not decomposable. Connected river segments have as part of their nature that at internal vertices, 
i.e., where two segments join, there are regions where paths must either cross a river or move away from the 
vertex, while for the individual segments, a path could bypass the river segment by simply moving around the 
vertex. Thus a set of connected river segments is not decomposable into its individual segments. 

Two high-level paradigms in addition to those used for single river segments are useful here. First, 
we partially sort the river segments according to their general visibility to the goal, i.e., so that a segment which 
is fully or partially occluded by another follows it in the partial order, and we process the segments according 
to this partial order. Thus boundaries which may affect other segments are already in place by the time the 
other segments are considered. Second, whenever a boundary intersects an occluded segment, an event point 
is generated. When a segment is processed, it is necessary to consider each event point and decide whether the 
boundary which caused the event point continues on the other side of the river segment. Figure 33 shows a 
river consisting of connected river segments, and Figure 34 shows a worst-case orientation of segments. 

Several new terms must be defined. General visibility between two terrain features is defined as fol- 
lows. Two features Ft and F n are generally visible with respect to a goal G if there is a sequence of features 
Fj, i=l to n, such that for all i, Fj is visible to Fj+i. A feature F; is occluded by another Fj with respect to goal 
G if for every sequence by which Fi and G are generally visible, Fj is a member of the sequence. In other words, 
Fi is occluded by Fj if it is partially or completely within the shadow of Fj cast by G. An endpoint V of line 
segment Li is defined as an exterior vertex if V is not an endpoint of any other line segment, or if segment L 2 
of which V is an endpoint occludes Li. V is defined as an interior vertex if it is not an exterior vertex. Intui- 
tively this means that an optimal path from an interior vertex must either cross the river or move away from 
the vertex to get past the line segment, while from an exterior vertex an optimal path can simply move around 
the vertex and bypass the river. Figure 33 shows the partial ordering of river segments as well as the exterior 
or interior nature of each vertex. 
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